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Abstract 


Geometric Nonlinear Control for Multiple Cooperative Quadrotor UAVs 

Transporting a Rigid Body 

This dissertation presents nonlinear tracking control systems for quadrotor unmanned 
aerial vehicles (UAV) under the influence of uncertainties. Assuming that there exist 
unstructured disturbances in the translational dynamics and the attitude dynamics, a 
geometric nonlinear adaptive controller is developed directly on the special Euclidean 
group. In particular, a new form of an adaptive control term is proposed to guaran¬ 
tee stability while compensating the effects of uncertainties in quadrotor dynamics. 
Next, we derived a coordinate-free form of equations of motion for a complete model 
of a quadrotor UAV with a payload which is connected via a flexible cable according 
to Lagrangian mechanics on a manifold. The flexible cable is modeled as a system of 
serially-connected links and has been considered in the full dynamic model. A geo¬ 
metric nonlinear control system is presented to asymptotically stabilize the position 
of the quadrotor while aligning the links to the vertical direction below the quadrotor. 
Finally, we focused on the dynamics and control of arbitrary number of quadrotor 
UAVs transporting a rigid body payload. The rigid body payload is connected to 
quadrotors via flexible cables. It is shown that a coordinate-free form of equations 
of motion can be derived for arbitrary numbers of quadrotors and links according to 
Lagrangian mechanics on a manifold. A geometric nonlinear controller is presented to 
transport the rigid body to a fixed desired position while aligning all of the links along 
the vertical direction. Numerical simulation and experimental results are presented 
and rigorous mathematical stability analysis are provided. These results will be par¬ 
ticularly useful for aggressive load transportation that involves large deformation of 
the cable. 
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Chapter 1: Introduction 


1.1 Motivation 

Quadrotor unmanned aerial vehicles (UAVs) are becoming increasingly pop¬ 
ular. They offer flight characteristics comparable to traditional helicopters, 
namely stationary, vertical, and lateral flights in a wide range of speeds, with 
a much simpler mechanical structure. With their small-diameter rotors driven 
by electric motors, these multi-rotor platforms are safer to operate than heli¬ 
copters in indoor environments. Also, they have sufficient payload transporting 
capability and flight endurance for various missions [1, 2, 3, 4]. UAVs have 
been studied for different applications such as surveillance or mobile sensor 
networks as well as for educational purposes. Quadrotors are very popular 
due to their dynamic simplicity, maneuverability and high performance. Areal 
transportation of a cable-suspended load has been studied traditionally for 
helicopters [5, 6]. Recently, small-size single or multiple autonomous vehicles 
are considered for load transportation and deployment [7, 8, 9, 10], and trajec¬ 
tories with minimum swing and oscillation of payload are generated [11, 12, 13]. 


Safe cooperative transportation of possibly large or bulky payloads is ex¬ 
tremely important in various missions, such as military operations, search and 
rescue, mars surface explorations and personal assistance. 



Figure 1: Arial payload transportation 
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However, these results are based on the common and restrictive assumption 
that the cable connecting the payload to the quadrotor UAV is always taut 
and rigid. Also, the dynamic of the cable and payload are ignored and they 
are considered as bounded disturbances to the transporting vehicle. There¬ 
fore, they cannot be applied to aggressive, rapid load transportations where 
the cable is deformed or the tension along the cable is low, thereby restricting 
its applicability. As such, it is impossible to guarantee safety operations. 

It is challenging to incorporate the effects of a deformable cable, since 
the dimension of the conhguration space becomes inhnite. Finite element 
approximation of a cable often yields complicated equations of motion that 
make dynamic analysis and controller design extremely difficult. 

1.2 Literature Review 

Several control systems have been proposed for quadrotors. In many cases, dis¬ 
turbances and uncertainties are eliminated in the model for simplicity. There 
are other limitations of quadrotor control systems, such as complexities in con¬ 
troller structures or lack of stability proof. For example, tracking control of a 
quadrotor UAV has been considered in [14, 15], but the control system in [14] 
has a complex structure since it is based on a multiple-loop backstopping ap¬ 
proach, and no stability proof is presented in [15]. Robust tracking control 
systems are studied in [16, 17], but the quadrotor dynamics is simplihed by 
considering planar motion only [16], or by ignoring the rotational dynamics by 
timescale separation assumption [17]. 

In other studies, disturbances and uncertainties have been considered into 
the dynamics of the quadrotors [18, 19, 20, 21]. Several controllers have been 
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designed and presented to eliminate these disturbances such as PID [22], sliding 
mode [23], or robust controllers [24], In one example, proportional-derivative 
controllers are developed with consideration of blade flapping for operations 
under wind disturbances [25]. A backstepping control method is proposed 
in [26] by considering an aggressive perturbation with bounded signals. These 
approaches have certain limitations on handling uncertainties. For example, 
it is well known that sliding mode controller causes chattering problems that 
may excite high-frequency unmodeled dynamics. Nonlinear robust tracking 
control systems in [27, 28] guarantee ultimate boundedness of tracking errors 
only, and they are also prone to chattering if the required ultimate bound is 
smaller. PID controllers are adopted widely, but it is required that the uncer¬ 
tainties are hxed. 

Due to the limitations mentioned above, adaptive controllers have been de¬ 
veloped [29, 30, 31, 32]. Although adaptive controllers compensate the effects 
of disturbances and uncertainties for quadrotor controls, most of the studies 
are based on linearization [29, 30] or simplihcation [31, 32]. In [31] only the 
constant external disturbances is considered into the system dynamics and 
the stability analysis. In [32] an adaptive block backstepping controller is 
presented to stabilize the attitude of a quadrotor, however this method only 
guarantees the boundedness of errors. A nonlinear adaptive state feedback 
controller is also presented in [33], where the proposed controller only assumes 
constant known disturbance forces. An adaptive sliding mode controller is 
developed for under-actuated quadrotor dynamics in [34]. This controller uses 
slack variables to overcome the under-actuated property of a quadrotor system 
while simplifying the dynamics to reduce the higher-order derivative terms 
which makes it very sensitive to the noise. A robust adaptive control of a 


3 



quadrotor is also presented in [35], where linear-in-the-parameter uncertain¬ 
ties and bounded disturbances are considered. These simplifications [31, 33], 
linearization [29, 30], and assumptions [32] in the dynamics and controller de¬ 
sign process of adaptive controllers restrict the quadrotor to maintain complex 
or aggressive missions such as a hipping maneuver [35]. 

The other critical issue in designing controllers for quadrotors is that they 
are mostly based on local coordinates. Local coordinates such as Euler an¬ 
gles and quaternions produce singularities and the dynamic model needs to be 
examined and studied more explicitly [36]. For quadrotor UAV’s dynamics, 
some aggressive maneuvers are demonstrated at [37] which are based on Eu¬ 
ler angles. Therefore they involve complicated expressions for trigonometric 
functions, and they exhibit singularities in representing quadrotor attitudes, 
thereby restricting their ability to achieve complex rotational maneuvers sig¬ 
nificantly. A quaternion-based feedback controller for attitude stabilization 
was shown in [38]. By considering the Coriolis and gyroscopic torques ex¬ 
plicitly, this controller guarantees exponential stability. Quaternions do not 
have singularities but, as the three-sphere double-covers the special orthogo¬ 
nal group, one attitude may be represented by two antipodal points on the 
three-sphere. This ambiguity should be carefully resolved in quaternion-based 
attitude control systems, otherwise they may exhibit unwinding, where a rigid 
body unnecessarily rotates through a large angle even if the initial attitude 
error is small [39]. To avoid these, an additional mechanism to lift attitude 
onto the unit-quaternion space is introduced [40]. 

The dynamics of a quadrotor UAV is globally expressed on the special Eu¬ 
clidean group, SE(3), and nonlinear control systems are developed to track 
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outputs of several flight modes [41], There are also several studies using 
the estimations for dynamical objects developed on the special Euclidean 
group [42, 43, 44], Several aggressive maneuvers of a quadrotor UAV or space¬ 
crafts are demonstrated based on a hybrid control architecture, and a nonlinear 
robust control system is also considered in [27, 45]. As they are directly devel¬ 
oped on the special Euclidean/Orthogonal group, complexities, singularities, 
and ambiguities associated with minimal attitude representations or quater¬ 
nions are completely avoided [46, 47, 48]. 

In most of the prior works, the dynamics of aerial transportation has been 
simplihed due to the inherent dynamic complexities. For example, it is as- 
snmed that the dynamics of the payload is considered completely decoupled 
from quadrotors, and the effects of the payload and the cable are regarded as 
arbitrary external forces and moments exerted to the qnadrotors [11, 12, 13], 
thereby making it challenging to snppress the swinging motion of the payload 
actively, particularly for agile aerial transportations. 

Recently, the coupled dynamics of the payload or cable has been explicitly 
incorporated into control system design [49]. In particular, a complete model 
of a quadrotor transporting a payload modeled as a point mass, connected via 
a flexible cable is presented, where the cable is modeled as serially connected 
links to represent the deformation of the cable [2]. In another distinct stndy, 
multiple quadrotors transporting a rigid body payload has been stndied [50], 
bnt it is assume that the cables connecting the rigid body payload and quadro¬ 
tors are always taut. These assumptions and simplihcations in the dynamics of 
the system reduce the stability of the controlled system, particnlarly in rapid 
and aggressive load transportation where the motion of the cable and payload 
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is excited nontrivially. 


1.3 Proposed Approches 

Geometric nonlinear controllers are developed to follow an attitude tracking 
command and a position tracking command. In particular, a new form of 
an adaptive control term is proposed to guarantee asymptotical convergence 
of tracking error variables when there exist uncertainties at the translational 
dynamics and the rotational dynamics of quadrotors. The corresponding sta¬ 
bility properties are analyzed mathematically, and they are verihed by several 
experiments [51]. The robustness of the proposed tracking control systems are 
critical in generating complex maneuvers, as the impact of the several aero¬ 
dynamic effects resulting from the variation in air speed is signihcant even at 
moderate velocities [25]. 

A coordinate-free form of the equations of motion for a chain pendulum 
connected a cart that moves on a horizontal plane is presented according to 
Lagrangian mechanics on a manifold [52]. The cable is modeled as an arbitrary 
number of links with different sizes and masses that are serially-connected by 
spherical joints. The resulting conhguration manifold is the product of the 
special Euclidean group for the position and the attitude of the quadrotor, 
and a number of two-spheres that describe the direction of each link. We 
present Euler-Lagrange equations of the presented quadrotor model that are 
globally dehned on the nonlinear conhguration manifold. 

The coupled dynamics of the payload or cable has been explicitly incor¬ 
porated into control system design [49]. In particular, a complete model of 
a quadrotor transporting a payload modeled as a point mass, connected via 
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a flexible cable is presented. In another distinct study, multiple quadrotors 
transporting a rigid body payload has been studied [50], but it is assumed 
that the cables connecting the rigid body payload and quadrotors are always 
taut. These assumptions and simplihcations in the dynamics of the system 
reduce the stability of the controlled system, particularly in rapid and aggres¬ 
sive load transportation where the motion of the cable and payload is excited 
nontrivially. 

Quadrotor UAV is under-actuated as the direction of the total thrust is 
always hxed relative to its body. By utilizing geometric control systems for 
quadrotor [41, 28, 45], we show that the hanging equilibrium of the links 
can be asymptotically stabilized while translating the quadrotor to a desired 
position. In contrast to existing papers where the force and the moment 
exerted by the payload to the quadrotor are considered as disturbances, the 
control systems proposed in this work explicitly consider the coupling effects 
between the cable/load dynamics and the quadrotor dynamics. 

1.4 Contributions 

The first distinct feature of the proposed approach is that the equations of 
motion and the control systems are developed directly on the nonlinear conhg- 
uration manifold in a coordinate-free fashion. This yields remarkably compact 
expressions for the dynamic model and controllers, compared with local coor¬ 
dinates that often require symbolic computational tools due to complexity of 
multi-body systems. Furthermore, singularities of local parameterization are 
completely avoided to generate agile maneuvers in a uniform way. 

This work presents a rigorous Lyapunov stability analysis to establish sta- 
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bility properties without any timescale separation assumptions or singular per¬ 
turbation, and a new nonlinear integral and adaptive control term are designed 
to guarantee robustness against unstructured uncertainties in both rotational 
and translational dynamics. 

The other distinct contribution of this dissertation is presenting the com¬ 
plete dynamic model of an arbitrary number of quadrotors transporting a rigid 
body where each quadrotor is connected to the rigid body via a flexible cable. 
Each flexible cable is modeled as an arbitrary number of serially connected 
links, and it is valid for various masses and lengths. A coordinate free form of 
equations of motion is derived according to Lagrange mechanics on a nonlinear 
manifold for the full dynamic model. These sets of equations of motion are 
presented in a complete and organized manner without any simplihcation. 

Another contribution of this study is designing a control system to sta¬ 
bilize the rigid body at desired position. Geometric nonlinear controller is 
utilized [41, 28, 45], and they are generalized for the presented model. More 
explicitly, we show that the rigid body payload is asymptotically transported 
into a desired location, while aligning all of the links along the vertical direc¬ 
tion corresponding to a hanging equilibrium. 

The unique property of the proposed control system is that the nontrivial 
coupling effects between the dynamics of rigid payload, flexible cables, and 
multiple quadrotors are explicitly incorporated into control system design, 
without any simplifying assumption. Also, the equations of motion and the 
control systems are developed directly on the nonlinear conhguration manifold 
intrinsically. Therefore, singularities of local parameterization are completely 



avoided to generate agile maneuvers of the payload in a uniform way. In short, 
the proposed control system is particularly useful for rapid and safe payload 
transportation in complex terrain, where the position of the payload should 
be controlled concurrently while suppressing the deformation of the cables. 

1.5 Publications 

The contributions in this dissertation have been published in the following 
journals and conference proceedings. 

• Farhad A. Goodarzi, Daewon Lee, Taeyoung Lee, Geometric Gontrol of a Quadro- 
tor UAV Transporting a Payload Gonnected via Flexible Gable, International 
Journal of Gontrol, Automation and Systems, Vol. 13, No. 6, December 2015. 

• Farhad A. Goodarzi, Daewon Lee, Taeyoung Lee, Geometric Adaptive Tracking 
Gontrol of a Quadrotor UAV on SE(3) for Agile Maneuvers, ASME Journal of 
Dynamic Systems, Measurement and Gontrol, 137(9), 091007-12, Sep 01, 2015 

• Farhad A. Goodarzi, Taeyoung Lee, Dynamic and Gontrol of Quadrotor UAVs 
Transporting a Rigid Body Gonnected via Flexible Gables, in Proceeding of 
American Gontrol Gonference, pp. 4677-4682, Ghicago, IL, July 2015 

• Farhad A. Goodarzi, Daewon Lee, Taeyoung Lee, Geometric Stabilization of a 
Quadrotor UAV with a Payload Gonnected by flexible Gable, in Proceeding of 
American Gontrol Gonference, pp. 4925-4930, Portland, OR, June 2014 

• Farhad A. Goodarzi, Daewon Lee, Taeyoung Lee, Geometric Nonlinear PID 
Gontrol of a Quadrotor UAV on SO(3), in Proceeding of European Gontrol 
Gonference, pp. 3845-3850, Zurich, Switzerland, February 2013 
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Chapter 2-Quadrotor Autonomous Trajectory Tracking 


In this chapter, we present a complete model of a quadrotor transporting a payload 
connecting with a flexible cable. The flexible cable is modeled as an arbitrary nnm- 
ber of serially connected links. Geometric nonlinear controller presented for the full 
dynamic model considering the coupling effects of payload and the cable. 

New contributions and the unique features of the control system proposed in this 
chapter compared with other studies are as follows: (i) it is developed for the full 
six degrees of freedom dynamic model of a quadrotor UAV on SE(3), including the 
coupling effects between the translational dynamics and the rotational dynamics on a 
nonlinear manifold without any simplihcation or assumptions, (ii) the control systems 
are developed directly on the nonlinear conhguration manifold in a coordinate-free 
fashion. Thus, singularities of local parameterization are completely avoided to gener¬ 
ate agile maneuvers in a uniform way, (hi) a rigorous Lyapunov analysis is presented 
to establish stability properties without any timescale separation assumption, and 
(iv) a new form of an adaptive control term is proposed to guarantee asymptotical 
convergence of tracking error variables in the presence of uncertainties, (v) in contrast 
to hybrid control systems [53], complicated reachability set analysis is not required 
to guarantee safe switching between different flight modes, as the region of attraction 
for each flight mode covers the conhguration space almost globally, (vi) the proposed 
algorithm is validated with experiments for agile maneuvers. A rigorous mathemat¬ 
ical analysis of nonlinear adaptive controllers for a quadrotor UAV on SE(3) with 
experimental validations for complex and aggressive maneuvers is unprecedented. 

The chapter is organized as follows. We develop a globally dehned model for a 
quadrotor UAV in Section 2.1. Adaptive tracking control systems are developed in 
Sections 2.2 and 2.3, followed by numerical examples in Section 2.4. 
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2.1 Quadrotor Dynamic Model 


Consider a quadrotor UAV model illustrated in Figure 2. We choose an inertial 
reference frame { 61 , 62 , 63 } and a body-fixed frame {fei,& 2 ,& 3 }- The origin of 
the body-hxed frame is located at the center of mass of this vehicle. The hrst 
and the second axes of the body-hxed frame, 61 , 62 , he in the plane dehned by 
the centers of the four rotors. 



The conhguration of this quadrotor UAV is dehned by the location of the 
center of mass and the attitude with respect to the inertial frame. Therefore, 
the conhguration manifold is the special Euclidean group SE(3), which is the 
semi-direct product of and the special orthogonal group SO(3) = (i? G 
R^^^\R'^R = I, detR=l}. 

The mass and the inertial matrix of a quadrotor UAV are denoted by 
m G M and J G Its attitude, angular velocity, position, and velocity are 
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defined by i? G S0(3), Q,x,v G respectively, where the rotation matrix 
R represents the linear transformation of a vector from the body-hxed frame 
to the inertial frame and the angular velocity hi is represented with respect to 
the body-hxed frame. The distance between the center of mass to the center 
of each rotor is d G M, and the Tth rotor generates a thrust fi and a reaction 
torque r* along —63 for 1 < f < 4. The magnitude of the total thrust and 
the total moment in the body-hxed frame are denoted by / G M, M G 
respectively. 

The following conventions are assumed for the rotors and propellers, and 
the thrust and moment that they exert on the quadrotor UAV. We assume 
that the thrust of each propeller is directly controlled, and the direction of the 
thrust of each propeller is normal to the quadrotor plane. The hrst and third 
propellers are assumed to generate a thrust along the direction of —63 when 
rotating clockwise; the second and fourth propellers are assumed to generate a 
thrust along the same direction of —63 when rotating counterclockwise. Thus, 
the thrust magnitude is / = /g and it is positive when the total thrust 
vector acts along — 63 , and it is negative when the total thrust vector acts 
along 63 . By the dehnition of the rotation matrix R G S0(3), the direction 
of the i-th body-hxed axis bi is given by Rci in the inertial frame, where 
Cl = [l;0;0],e2 = [0;l;0],e3 = [0;0;1] G Therefore, the total thrust 
vector is given by —fRe^ G in the inertial frame. 

We also assume that the torque generated by each propeller is directly 
proportional to its thrust. Since it is assumed that the hrst and the third pro¬ 
pellers rotate clockwise and the second and the fourth propellers rotate coun¬ 
terclockwise to generate a positive thrust along the direction of — 63 , the torque 
generated by the i-th propeller about 63 can be written as r* = {—lycrffi for 
a hxed constant Crf- All of these assumptions are fairly common in many 
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quadrotor control systems [38, 54], 

Under these assumptions, the thrust of each propeller /i,/ 2 ,/ 3,/4 is di¬ 
rectly converted into / and M, or vice versa. In this paper, the thrust magni¬ 
tude / G M and the moment vector M G are viewed as control inputs. The 
corresponding equations of motion are given by 


X = V, (1) 

mv = mges — fRes + Wxi^XjV, R,fl)9x, ( 2 ) 

R = rCi, (3) 

m + nx jn = M + WR{x,v,R,n)eR, (4) 


where the hat map ": SO(3) is dehned by the condition that xy = x x y 

for all x,y E More explicitly, for a vector x = [xi, X 2 , x^]'^ G the matrix 
X is given by 



0 

-xz 

X2 


X = 


0 

-Xl 

(5) 


-X2 

Xl 

0 

. _o 



This identihes the Lie algebra SO(3) with using the vector cross product in 
The inverse of the hat map is denoted by the vee map, V ; S0(3) —)■ 

The modeling error and uncertainties in the translational dynamics and the 
rotational dynamics are given by W^{x,v, R,fl)9x, and Wr^XjV, R,Q)9r, re¬ 
spectively. Where Wx{x, v, R, Q),Wr{x, v, R, O) G are known functions 

of the state, and 9x,9r G are hxed unknown parameters. It is assumed 

that the bounds of unknown parameters are given by 

mx\\<Bw^, \\9x\\<Be, \\9R\\<Be, (6) 
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for B\y^,Bq > 0. Throughout this chapter, Am(^) and \m{^) denote the 
minimum eigenvalue and the maximum eigenvalue of a square matrix A, re¬ 
spectively, and Am and Am are the minimum eigenvalue and the maximum 
eigenvalue of the inertia matrix J. i.e.. Am = Am(^) and Am = The 

two-norm of a matrix A is denoted by ||A||. The standard dot product in 
is denoted by •, i.e., x ■ y = x'^y for any x,y E M”. 

2.2 Attitude Controlled Flight Mode 

Since the quadrotor UAV has four inputs, it is possible to achieve asymptotic 
output tracking for at most four quadrotor UAV outputs. The quadrotor 
UAV has three translational and three rotational degrees of freedom; it is not 
possible to achieve asymptotic output tracking of both attitude and position of 
the quadrotor UAV. This motivates us to introduce two flight modes, namely 
(1) an attitude controlled flight mode, and (2) a position controlled flight 
mode. While a quadrotor UAV is under-actuated, a complex flight maneuver 
can be dehned by specifying a concatenation of flight modes together with 
conditions for switching between them. This will be further illustrated by a 
numerical example and experimental results later. In this section, the attitude 
controlled flight mode is considered. 

2.2.1 Attitude Tracking Errors 

Suppose that a smooth attitude command Rd(t) E SO(3) satisfying the fol¬ 
lowing kinematic equation is given: 

Rd = Rd^d: (7) 
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where fld{t) G is the desired angular velocity, which is assumed to be uni¬ 
formly bounded. We first dehne errors associated with the attitude dynamics 
as follows [55, 56]. 

Proposition 1 For a given tracking command {Rd, fid), and the current attitude and 
angular velocity we define an attitude error function d' ; S0(3) x S0(3) —)■ M, 

an attitude error vector cr G and an angular velocity error vector e^ G as 
follows [56]: 



( 8 ) 

eR = \{.GRZR-R^RiG)\ 

( 9 ) 


( 10 ) 


where the matrix G G is given by G = dmg[gi, g 2 , gs] for distinct, positive 

constants gi, g 2 , gs G M. Then, the following properties hold: 

(i) d/ is positive-definite about R = Rd- 

(a) The directional derivative o/'h with respect to R along 6R = Rfj for any 77 G 
is given by 


— d'(i?exp(eJ7),i?d) = cr ■ 77. (11) 

e=0 

(Hi) The critical points o/d/, where cr = 0, are {Rd} U exp(7rs), s G S^}, where 

52 = {s G I ||s|| = 1 }, 

(iv) A lower bound o/d/ is given as follows: 

bi\\eR\\^ <df{R,Rd), ( 12 ) 
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where the constant bi is given by bi = for 


hi = min{ 5 (i + 5(2,5-2 + fl-s, 5'3 + fi-i}, 

/i2 = max{(^i - ^2)^ {92 - 93)^, {93 - 9 if}, 
hs = max{(^i + ^2)^ {92 + ^ 3 )^ (^3 + ^i)^}- 

(v) Let fj be a positive constant that is strictly less than 2 . //']>(/?, i?^) < -ip < hi, 
then an upper bound of 'I' is given by 

']/(/?, i?rf) < 62||ei?|p, ( 13 ) 

where the constant 62 is given by 62 = for 

hi = max{5(i + g2 ,92 + 93:93 + fi-i}, 

/i5 = min{(^i + ^2)^ {92 + 93Y, {93 + 

(vi) The time-derivative of ^ and cr satisfies: 

'^ = OR-e^, ||e/j|| < ||en||. ( 14 ) 


Proof 1 See Appendix A.l . 

2.2.2 Attitude Tracking Controller 

We now introduce a nonlinear controller for the attitude controlled flight mode: 
M = — kRCR — kncn — WrOr + {FF Rdkld)'^ JR^ RdAld + JRF Rdfld: (15) 
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and adaptive law 


+ C2e/j), (16) 

where kn, kQ,C 2 ,'yR are positive constants and 9r G denotes the estimated 
value of 9r. The adaptive gains for and cr correspond to jr and C 27 _r, 
respectively. 

The control moment is composed of proportional, derivative, and adaptive 
terms, augmented with additional terms to cancel out the angular acceleration 
caused by the desired angular velocity. 

Proposition 2 (Attitude Controlled Flight Mode) Consider the control moment M 
defined in (15)-(16). For positive constants kR,kQ, the constants C 2 ,i ?2 chosen 
such that 


||(2J-tr|J]/)||||fi,|| <B 2 , 

r VknXm 4/cn 

\ Am ’ 8kR\M + (kn + B2) 



(17) 

(18) 


Then, the zero equilibrium of tracking errors and the estimation errors is stable in 
the sense of Lyapunov, and eR,e^ —)■ 0 ast^oo. Furthermore the estimation error, 
9r = Or — 9r, is uniformly bounded. 


Proof 2 See Appendix A.2 . 

While these results are developed for the attitude dynamics of a quadro- 
tor UAV, they can be applied to the attitude dynamics of any rigid body. 
Nonlinear adaptive controllers have been developed for attitude stabilization 
in terms of modihed Rodriguez parameters [57] and quaternions [58], and for 
attitude tracking in terms of Euler-angles [59]. The proposed tracking control 
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system is developed on SO(3), therefore it avoids singularities of Euler-angles 
and Rodriguez parameters, as well as unwinding of quaternions. 

Asymptotic tracking of the quadrotor attitude does not require specihca- 
tion of the thrust magnitude. As an auxiliary problem, the thrust magnitude 
can be chosen in many different ways to achieve an additional translational mo¬ 
tion objective. For example, it can be used to asymptotically track a quadrotor 
altitude command [28]. Since the translational motion of the quadrotor UAV 
can only be partially controlled; this flight mode is most suitable for short 
time periods where an attitude maneuver is to be completed. 

2.3 Position Controlled Flight Mode 

We introduce a nonlinear controller for the position controlled flight mode in 
this section. 

2.3.1 Position Tracking Errors 

Suppose that an arbitrary smooth position tracking command Xd{t) G is 
given. The position tracking errors for the position and the velocity are given 
by: 


e^ = x-Xd, e^ = e^ = v - Xd- (19) 

In the position controlled tracking mode, the attitude dynamics is controlled 
to follow the computed attitude Rcif) G S0(3) as illustrated in Figure 3 and 
the computed angular velocity VLcif) defined as 

Rc = ha X ha', ha], = R^Rc, (20) 
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where 63 ^ G is given by 


, -Kex - - 'WxOx - mge3 + mxd . 

^3 — —Ti-^-FT’ 

W-kxCx - Ke^ - WxOx - mge^ + rnxd\\ 

for positive constants kx, k^ and 6x G denotes the estimate value of 6x- The 



X, V, R, fi 

Figure 3: Controller loops 


unit vector bi^ G is selected to be orthogonal to 63^, thereby guaranteeing 
that Rc G SO(3). It can be chosen to specify the desired heading direction, 
and the detailed procedure to select bic is described later at Section 2.3.3. 
Following the prior dehnition of the attitude error and the angular velocity 
error given at (9) and (10), and assume that the commanded acceleration is 
uniformly bounded: 


II — mge^ + mxd\\ < Bi (22) 

for a given positive constant B^. These imply that the given desired position 
command is distinctive from free-fall, where no control input is required. 
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2.3.2 Position Tracking Controller 


The nonlinear controller for the position controlled flight mode, described by 
control expressions for the thrust magnitude and the moment vector, are: 

/ ={kxex + + 'WxOx + mges - mxd) ■ Res, (23) 

M = - kRCR - knen - ^rOr + RMcT JRMc + JR^RMc- (24) 


In 23, we can show that the total thrust is always positive. The first term in 
this equation is the projection into 63 and while controller works perfectly we 
can guarantee that the angle between two terms in 23 is always less than 90 
degree and it happens when R is close to Rc- Similar with (16), an adaptive 
control law for the position tracking controller is defined as 


'Ix^^x eiCx) 


e 


X 


< 


if ll^xll < Be 

or II02,II = Be 

and 0jWj(e,; + CiCx) < 0 > (25) 


72,(1 - ^^)Wj(e„ + 0162,) Otherwise 

for a positive adaptive gain 72 , and a weighting parameter ci. The correspond¬ 
ing effective adaptive gain for Cx corresponds to C 172 ,. The above expression 
correspond adaptive controls with projection [60] and it is included to restrict 
the effects of attitude tracking errors on the translational dynamics as shown 
in Figure 4 

The nonlinear controller given by equations (23), (24) can be given a back- 
stepping interpretation. The computed attitude Rc given in equation (20) is 
selected so that the thrust axis —63 of the quadrotor UAV tracks the computed 
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direction given by — 63 ^ in ( 21 ), which is a direction of the thrust vector that 
achieves position tracking. The moment expression (24) causes the attitude 
of the quadrotor UAV to asymptotically track Rc and the thrust magnitude 
expression (23) achieves asymptotic position tracking. 

Proposition 3 (Position Controlled Flight Mode) Suppose that the initial eonditions 
satisfy 




(26) 


for positive eonstant fji. Consider the eontrol inputs f,M defined in (23)-(2f). For 
positive constants we choose positive constants Ci, C 2 ,/c/j ,/cq such that 


Cl < min 


4:kxk^{l - ay 


k^{l + ay + Amkx{l — a) ’ 


A„^(fP2) > 




12 


4A„(»1)’ 



(27) 

(28) 


and (237) is satisfied, where a = a/'^i(2 — ^i), and the matrices Wi, W 12 , W 2 G 


21 



are given by 


CikAl — ex) —^^(l + a) 

Wi= " ' , (29) 

_cj^(l_l_Q,) — a) — mcl 

Ci(Bi 4/^B0 + Bi) 0 
Bw^Bg + Bi + kxCx^^^ 0 

C2kR -f{kn + B2) 

-f{kn + B2) k^-2c2\M 

This implies that the zero equilibrium of the traeking errors and the estimation errors 
is stable in the sense of Lyapunov and all of the traeking error variables asymptotically 
converge to zero. Also, the estimation errors are uniformly bounded. 

Proof 3 See Appendix A.3 . 

Proposition 3 requires that the initial attitude error is less than 90° in (26). 
Suppose that this is not satisfied, i.e. 1 < \h(i?(0), i?c(0)) < 2 . We can still 
apply Proposition 2, which states that the attitude error is asymptotically 
decreases to zero for almost all cases, and it satisfies (26) in a finite time. 
Therefore, by combining the results of Proposition 2 and 3, we can show 
attractiveness of the tracking errors when \h(i?( 0 ), i?c( 0 )) < 2 . 

Proposition 4 (Position Controlled Flight Mode with a Larger Initial Attitude Er¬ 
ror) Suppose that the initial conditions satisfy 

l<>l'(fl(0),fl,(0))<2, ||e.(0)|| < (32) 

for a constant Consider the control inputs /, M defined in (23)-(24), where the 

control parameters satisfy (26)-(28) for a positive constant < 1. Then the zero 
equilibrium of the tracking errors is attractive, i.e., e^, e^, cr, cq —)■ 0 as t ^ 00 . 





22 



Proof 4 See Appendix A.4 ■ 


Linear or nonlinear PID and adaptive controllers have been widely used for 
a quadrotor UAV. But, they have been applied in an ad-hoe manner without 
stability analysis. This paper provides a new form of nonlinear adaptive con¬ 
troller on SE(3) that guarantees almost global attractiveness in the presence 
of uncertainties. 

Compared with other PID controllers requiring that uncertain terms should 
be hxed, the proposed adaptive control system can handle more general class of 
uncertainties. The nonlinear robust tracking control system in [27, 28] provides 
ultimate boundedness of tracking errors, and the control input may be prone 
to chattering if the required ultimate bound is smaller. Compared with [28], 
the control system in this paper guarantees stronger asymptotic stability, and 
there is no concern for chattering. 

2.3.3 Direction of the First Body-Fixed Axis 

As described above, the construction of the orthogonal matrix Rc involves 
having its third column 63 ^ specified by ( 21 ), and its first column is arbi¬ 
trarily chosen to be orthogonal to the third column, which corresponds to a 
one-dimensional degree of choice. 

By choosing hi^ properly, we constrain the asymptotic direction of the first 
body-fixed axis. Here, we propose to specify the projection of the first body- 
fixed axis onto the plane normal to 63 ^. In particular, we choose a desired di¬ 
rection hd G S^, that is not parallel to 63 ^, and bi^ is selected as bi^ = Proj[ 6 i^], 
where Proj [■] denotes the normalized projection onto the plane perpendicular 
to 63 ^. In this case, the first body-fixed axis does not converge to bi^, but it 
converges to the projection of bi^, i.e. bi —)■ bi^ = Proj [ 61 ^] as t —)■ cx). This can 
be used to specify the heading direction of a quadrotor UAV in the horizontal 
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plane [28]. 


2.4 Numerical Example 

An aggressive flipping maneuver is considered for a numerical simulation. The 
quadrotor parameters are chosen as 

5.5711 0.0618 -0.0251 

J= 0.06177 5.5757 0.0101 xlO’^kgm^ 

-0.02502 0.01007 1.05053 

m = 0.755 kg, d = 0.169 m, Crf = 0.1056. 

Also, controller parameters are selected as follows: kx = 6.0, = 3.0, kn = 

0.7, kn = 0.l2, Cl = 0.1, Cs = 0.1. 

In this simulation, initial state of the quadrotor UAV is at a hovering 
condition: a;(0) = n(0) = 11(0) = Osxi, and i?(0) = /sxs- The desired trajec¬ 
tory is a flipping maneuver where the quadrotor rotates about rotation axis 
Cr = [^, ^,0] by 360°. This is a complex maneuver combining a nontrivial 
pitching maneuver with a yawing motion. It is achieved by concatenating the 
following two control modes: 

(i) Attitude tracking to rotate the quadrotor (t < 0.375) 

Rd{t) = I + sin(47rt)er + (1 — cos{47rt)){ereJ — /), 11^ = 47r ■ e^. 

(ii) Trajectory tracking to make it hover after completing the preceding rotation 
(0.375 <t<2) 

a;,(t) = [0,0,0]^, = [1,0,0]^. 
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We considered two cases for this numerical simulation to compare the effect 
of the proposed adaptive term in the presence of disturbances. In this numer¬ 
ical simulation we considered a special case of = hxs and Wr = hxs- 
Two cases are as follows: (i) with adaptive term and (ii) without the adaptive 
term, where constant disturbances are dehned as 

Or = [0.03, -0.06, 0.09]^, 9^ = [0.25, 0.125, 0.2]^ 

The switching time is determined as follows. The desired angular velocity 
of the hrst attitude tracking mode is dvr, which means it requires 0.5 sec for 
one revolution but the control mode is switched to trajectory tracking mode 
at t = 0.375 sec to compensate rotational inertia. It is also assumed that 
the maximum thrust at each rotor is given by = 3.2 N, and any thrust 
command above the maximum thrust is saturated to represent the actual 
motor limitation in the numerical simulation. Snapshots of the maneuver 


^ j 

P.o '' 



Figure 5: Snapshots of a flipping maneuver: the red line denotes the rotation axis 
Cr = [:^, 0]. The quadrotor UAV rotates about the axis by 360°. The 

trajectory of its mass center is denoted by blue, dotted lines. 

are presented at Figure 5 and numerical results are illustrated at Figures 6 
and 7, where it is shown that the adaptive terms eliminate the steady state 
error. The altitude drop during the flipping maneuver is reduced noticeably. 
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(d) Angular Velocity error (e) Angular Velocity (f) Position x,Xd{m) 

en(rad/sec) (rad/s) 


Figure 6: Flipping without adaptive term (dotted:desired, solid:actual) 




(d) Angular Velocity error (e) Angular Velocity (f) Position x,Xd{xa) 

en(rad/sec) (rad/s) 


Figure 7: Flipping with adaptive term (dotted:desired, solid:actual) 
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Chapter 3: Quadrotor UAV Transporting a Payload with Flexible 

Cable 

The main contribution of this chapter is presenting a nonlinear dynamic model and 
a control system for a quadrotor UAV with a cable-suspended load, that explicitly 
incorporate the effects of deformable cable. 

This chapter is organized as follows. In section 3.1, equations of motion in 3D 
space for a chain pendulum on a quadrotor are derived. Section 3.2, talks about the 
dynamics equation, linearization, and linear control design for a chain pendulum on 
a cart moving in 3D. Section 3.3 presents the proposed geometric nonlinear controller 
and stability analysis to asymptotically stabilize the chain pendulum on a quadrotor. 
In section 3.4, we provide numerical simulations results to validate our work. 

3.1 Quadrotor Dynamic Model 

Consider a quadrotor UAV with a payload that is connected via a chain of 
n links, as illustrated at Figure 22. The inertial frame is dehned by the unit 
vectors ei = [1; 0; 0], 62 = [0; 1; 0], and 63 = [0; 0; 1] G and the third axis 63 
corresponds to the direction of gravity. Dehne a body-hxed frame 
whose origin is located at the center of mass of the quadrotor, and its third 
axis 63 is aligned to the axis of symmetry. 

The location of the mass center, and the attitude of the quadrotor are 
denoted by a; G and R G SO(3), respectively, where the special orthogonal 
group is SO(3) = {i? G | R^R = /3X3, det[i?] = 1}. A rotation matrix 
represents the linear transformation of a representation of a vector from the 
body-hxed frame to the inertial frame. 

The dynamic model of the quadrotor is identical to [41]. The mass and 
the inertia matrix of the quadrotor are denoted by m G M and J G 
respectively. The quadrotor can generates a thrust —fRe^ G with respect 
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Figure 8: Quadrotor UAV with a cable-suspended load. Cable is modeled as a serial 
connection of arbitrary number of links (only 5 are illustrated). 

to the inertial frame, where / G M is the total thrust magnitude. It also 
generates a moment M G with respect to its body-hxed frame. The pair 
(/, M) is considered as control input of the quadrotor. 

Let Qi G be the unit-vector representing the direction of the Tth link, 
measured outward from the quadrotor toward the payload, where the two- 
sphere is the manifold of unit-vectors in i.e., = {g G | ||g|| = 1}. 

For simplicity, we assume that the mass of each link is concentrated at the 
outboard end of the link, and the point where the hrst link is attached to the 
quadrotor corresponds to the mass center of the quadrotor. The mass and 
the length of the Tth link are dehned by and U G M, respectively. Thus, 
the mass of the payload corresponds to m„. The corresponding conhguration 
manifold of this system is given by S0(3) x x (S^)". 




Next, we show the kinematics equations. Let G be the angular 
velocity of the quadrotor represented with respect to the body hxed frame, 
and let Ui G be the angular velocity of the i-th link represented with 
respect to the inertial frame. The angular velocity is normal to the direction 
of the link, i.e., qi ■ Ui = 0. The kinematics equations are given by 

R = Rn, ( 33 ) 

qi = Ui X Qi = Uiqi. ( 34 ) 

Throughout this chapter, the 2-norm of a matrix A is denoted by ||A||, and 
the dot product is denoted hy x ■ y = x^y. Also Amin(-) and Amax(-) denotes 
the minimum and maximum eigenvalue of a square matrix respectively, and 
Am and Am are shorthand for Am = Am(^) and Am = 

3.1.1 Lagrangian 

We derive the equations of motion according to Lagrangian mechanics. The 
kinetic energy of the quadrotor is given by 

Tq = ^m\\x\\'^+ ■ JQ. ( 35 ) 

Let Xi G be the location of m* in the inertial frame. It can be written as 

i 

Xi = xa'^ Rqa- ( 36 ) 

a=l 
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Then, the kinetic energy of the links are given by 


^ / 1 - t 

Tl = + y^/qgalP 

2=1 a=l 

^ n n n 1 ^ ^ 

= ^'^rni\\x\\ + X ■ ’^’^makqi + '^laQaW^ ■ (37) 

2=1 2=1 a=i 2=1 a=l 

From (35) and (37), the total kinetic energy can be written as 

1 n ^ n ^ 

T = -Moo||i|P + X ■ MQiQi + - MijQi ■ Qj + (38) 

2=1 ^J = l 

where the inertia values Mqo, Mqi, Mij G M are given by 


n 

Moo = m + '^rrii, 

n 

Moi = '^mali, Mio = Moi, 


2=1 

a=i 


Mij = < 

\ ^ 1 

(39) 


1 a=max{ 2 ,ji} J 



for 1 < i, j < n. The gravitational potential energy is given by 

n 

V = -mgx • es - ^ rriigxi ■ 63 

2 = 1 

n n 

= -EE rriaghe^ ■ Qi - Mooge^ ■ x, (40) 

2=1 a=i 

From (38) and (40), the Lagrangian is L = T — V. 

3.1.2 Euler-Lagrange equations 

Coordinate-free form of Lagrangian mechanics on the two-sphere and the 
special orthogonal group SO(3) for various multi-body systems has been stud¬ 
ied in [61, 62], The key idea is representing the inhnitesimal variation of 
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R G so(3) in terms of the exponential map 

expi?(eJ 7 ) = Rfj, (41) 

e=0 

for ?7 G The corresponding variation of the angular velocity is given by 
5VL = 7] + VL X 1 ]. Similarly, the inhnitesimal variation of g* G is given by 

= 6 X Qh (42) 

for G satisfying ■ g* = 0. This lies in the tangent space as it is perpen¬ 
dicular to g*. Using these, we obtain the following Euler-Lagrange equations. 

Proposition 5 Consider a quadrotor with a cable suspended payload whose Lagrangian 
is given by (38) and (40). The Euler-Lagrange equations on x SO(3) x (S^)” are 
as follows 

n 

Moqx + Tfoig'i = —fRe^ Mqqqc^ A^, (43) 

i=l 

n n 

Mudi - diiMiox + ^ Mijdj) = -Mii\\qi\\‘^qi - ^ rnaghg^es, (44) 

j=l a=i 

m + nm = m + a^, ( 45 ) 

where Mij is defined at (39). Therefore and Ar G are fixed disturbances applied 
to the translational and rotational dynamics of the quadrotor respectively. Equations 
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(43) and (44) can he rewritten in a matrix form as follows: 


Mqo 

Mqi 

Mq2 

Mon 


X 

-qfMio 

Mills 

-Mi2ql ■ ■ 

■ -Minfl 


qi 

—qlM2o 

-M2iql 

M 22 I 3 

■ -M2nql 


q2 

-qlMno 

-Mniql 

-Mn2ql ■ ■ 

Mnnh 


qn_ 


~fRc^ + ^OOfi'Cs + Aa: 
-IlgilpMiigi - YZ=i^aghqlez 
-\\q 2 fM 22 q 2 - EL 2 cnagkq^es 


[ -\\qn\\‘^Mnnqn- mnglnqles \ 

Or equivalently, it can he written in terms of the angular velocities as 


Mqo 

-Moifi 

— Mo2g2 

Miinqn 


X 

qiMio 

Mills 

-Mi2qiq2 ■ ■ ■ 

-Minflfn 


Ui 

q2M2o 

-M2iq2qi 

M 22/3 

-M2nq2qn 


CJ2 

0 

■ 

-Mniqnqi 

-Mn2qnq2 ■ ■ ■ 

MnnR 


Cjn 


EJ=i Moj\\ujj 

W'^qj - fRes + Mooges + 




maghqies 


= 

Ej=ljV2^2i 

Hrq2q^ + El 

=2 cuaghhcz 



qnqj IT^nglnqnCs 

qi = UiX qi. 


(46) 


(47) 


(48) 


Proof 5 See Appendix A.5 
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These provide a coordinate-free form of the equations of motion for the pre¬ 
sented quadrotor UAV that is uniformly dehned for any number of links n, 
and that is globally defined on the nonlinear conhguration manifold. Com¬ 
pared with equations of motion derived in terms of local coordinates, such as 
Euler-angles, these avoid singularities completely, and they provide a compact 
form of equations that are suitable for control system design. 

However, the presented finite element model may not capture the certain 
dynamic characteristics of the actual cable dynamics represented by partial 
differential equations. Designing a control system for such inhnite-dimensional 
system is beyond the scope of this dissertation. 

3.2 Control System Design for a Simplified Dynamic Model 

Let Xd G be a fixed desired location of the quadrotor UAV. Assuming that 
all of the links are pointing downward, i.e., qi = 63 , the resulting location of 
the payload is given by 

n 

i=l 

We wish to design the control force / and the control moment M such that 
this hanging equilibrium conhguration at the desired location becomes asymp¬ 
totically stable. 

3.2.1 Control Problem Formulation 

For the given equations of motion (43) for x, the control force is given by 
—fRe^. This implies that the total thrust magnitude / can be arbitrarily 
chosen, but the direction of the thrust vector is always along the third body- 
hxed axis. Also, the rotational attitude dynamics of the quadrotor is not 
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affected by the translational dynamics of the quadrotor or the dynamics of 

links. 

To overcome the under-actuated property of a quadrotor, in this section, 
we hrst replace the term —fRe^ of (43) by a hctitious control input m G 
and design an expression for u to asymptotically stabilize the desired equi¬ 
librium. This is equivalent to assuming that the attitude R of the quadrotor 
can be instantaneously controlled. The effects of the attitude dynamics are 
incorporated at the next section. Also is ignored in the simplihed dynamic 
model. In short, the equations of motion for the simplihed dynamic model 
considered in the section are given by 

n 

Moox + ^ MoiQi = u + MooS'Cs, (50) 

i=l 

and (44). 

3.2.2 Linear Control System 

The hctitious control input is designed from the linearized dynamics about the 
desired hanging equilibrium. The variation of x and u are given by 

6x = X — Xd, 6u = u — Mqqqcz. (51) 

From (78), the variation of g* from the equilibrium can be written as 


5qi = Ci X es, (52) 

where G with = 0. The variation of ca* is given by 6u G 

with Sui ■ 63 = 0. Therefore, the third element of each of and Sui for 
any equilibrium conhguration is zero, and they are omitted in the following 
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linearized equation, i.e., the state vector of the linearized equation is composed 
of e where C = [a, cs] G M3 x2_ 


Proposition 6 The linearized equations of the simplified dynamic model (50) and 
(44) can be written as follows 

Mx + Gx = B(5 m + 0(x, x), (53) 


where 0(x, x) corresponds to the higher order terms where x = [5x, Xg]^ G 
M G ]R 2 n+ 3 x 2 n+ 3 ^ Q ^ ]^ 2 n+ 3 x 2 n+ 3 ^ g ^ ]^ 2 n+ 3 x 3 ^ cQuivalently bc Written 

as 

h / 

bu + 0(x, x), 

02nx3 



where the corresponding sub-matrices are defined as 


Ma;a, = MqqIs, 

Ma:g = —MoiCsC —Mq2CsC ■ ■ ■ —MonC^C ; 
Mgx = 

Muh M12I2 ■ ■ ■ Minh 
M21I2 M22I2 ■ ■ ■ M2nl2 

Mgg = ^ ’ 

Mnlh Mn2l2 ' ' ' Mnnh 

n 

Gqq = diag[ ^ mapllh, • • ■ , mnglnh] ■ 
a=\ 

Proof 6 See Appendix A.6 
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For the linearized dynamics (53), the following control system is chosen 

n 

5u = —kxSx — k±5x — kq^C'^{es x qi) — k^^C^5ui 

a=l 

= - i^iX, (54) 

for controller gains ^qi-^3x2, • • •e M3x(3+2n) ^ 

[fci/s, A;(^^/3 x 2, • • • ^a;„-f3x2] ^ ]^3x(3+2n)_ Provided that (53) is controllable, we 
can choose the controller gains K^, Kj. such that the equilibrium is asymp¬ 
totically stable for the linearized equation (53). Then, the equilibrium be¬ 
comes asymptotically stable for the nonlinear Euler Lagrange equation (50) 
and (44) [63]. The controlled linearized system can be written as 

ii =A2 :i -I- B 0(x, x), (55) 

where Zi = [x, x]"^ G and the matrices A G ]R4n+6x4n+6 jg ^ 

]^4n-i-6x2n+3 gj,g dehued as 

0/0 

A= ,B= . (56) 

-M-i(G + BA„) -(M'^BAi) 

We can also choose Ax and Ax such that A is Hurwitz. Then for any positive 
dehnite matrix Q G ]p4n+6x4n+6^ there exist a positive dehnite and symmetric 
matrix P G ]R4n+6x4n-i-6 ggpp js^Tp _|_ _ _Q according to [63, Thm 

3.6]. 

3.3 Controller Design for a Quadrotor with a Flexible Cable 

The control system designed in the previous section is generalized to the full 
dynamic model that includes the attitude dynamics. The central idea is that 
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the attitude R of the quadrotor is controlled such that its total thrust direction 
—Re^ that corresponds to the third body-fixed axis asymptotically follows the 
direction of the hctitious control input u. By choosing the total thrust mag¬ 
nitude properly, we can guarantee that the total thrust vector —fRe^ asymp¬ 
totically converges to the hctitious ideal force u, thereby yielding asymptotic 
stability of the full dynamic model. 

3.3.1 Controller Design 

Consider the full nonlinear equations of motion, let A G be the ideal to¬ 
tal thrust of the quadrotor system that asymptotically stabilize the desired 
equilibrium. From (51), we have 

A = Mooges + du = -K^x - K±x - sat(ej + Mooges, (57) 

(7 

where the following integral term Cx G is added to eliminate the effect 

of disturbance A^, in the full dynamic model 

Cx = / (RB)^zi(t) dr, (58) 

Jo 

where = [kzh,kz-^l 3 x 2 : ■ ■ ■ kz„l 3 x 2 \ ^ ]R3x(3+2n) jg integral gain. For a 
positive constant a G M, a saturation function sat^- : M —)■ [—a, a] is introduced 
as 

if y > a 

if — a < y < a ■ 
if y < —a 
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If the input is a vector y G M”, then the above saturation function is applied 
element by element to define a saturation function sato-(|/) : —)■ [—a, a]"' for 
a vector. It is also assumed that an upper bound of the inhnite norm of the 
uncertainty is known 


lA. 


<■5, 


(59) 


for positive constant 5. The desired direction of the third body-hxed axis 
63^ G is given by 


b 


3c - 



(60) 


This provides a two-dimensional constraint for the desired attitude of quadro- 
tor, and there is additional one-dimensional degree of freedom that corresponds 
to rotation about the third body-fixed axis, i.e., yaw angle. A desired direction 
of the hrst body-hxed axis, namely bi^ G is introduced to resolve it, and it 
is projected onto the plane normal to 63^. The desired direction of the second 
body-hxed axis is chosen to constitute an orthonormal frame. More explicitly, 
the desired attitude is given by 


Rc 


ilA, 


h.liu 



(61) 


which is guaranteed to he in SO(3) by construction, assuming that bi^ is not 
parallel to 63^ [28]. The desired angular velocity Oc G 1^^ is obtained by the 
attitude kinematics equation 




C 




(62) 
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Next, we introduce the tracking error variables for the attitude and the angular 
velocity cr, cq G as follows [64] 


eR = ]^{RlR-R^Rf)\ 

(63) 

e^ = kl — R^ RcLlc- 

(64) 


The thrust magnitude and the moment vector of quadrotor are chosen as 


f = -A- Res, 


(65) 


and 


M = —kRtR — knen — kjej + hi x Jfl — JRcQc — R^Rc^c), (66) 


where kR, kn, and kj are positive constants and the following integral term is 
introduced to eliminate the effect of hxed disturbance Ar 


ei 


eo(r) + C 2 eR{T)dT, 


(67) 


where C2 is a positive constant. 


3.3.2 Stability Analysis 

Proposition 7 Consider control inputs f, M defined in (105) and (106). There exist 
controller parameters and gains such that, (i) the zero equilibrium of tracking error is 
stable in the sense of Lyapunov; (ii) the tracking errors or, en, x, x asymptotically 
converge to zero as t ^ oo; (Hi) the integral terms c/ and Cx are uniformly bounded. 

Proof 7 See Appendix A.7 
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By utilizing geometric control systems for quadrotor, we show that the hang¬ 
ing equilibrium of the links can be asymptotically stabilized while translating 
the quadrotor to a desired position. The control systems proposed explic¬ 
itly consider the coupling effects between the cable/load dynamics and the 
quadrotor dynamics. We presented a rigorous Lyapunov stability analysis to 
establish stability properties without any timescale separation assumptions or 
singular perturbation, and a new nonlinear integral control term is designed 
to guarantee robustness against unstructured uncertainties in both rotational 
and translational dynamics. 

3.4 Numerical Example 

The desirable properties of the proposed control system are illustrated by a 
numerical example. Properties of a quadrotor are chosen as 

m = 0.5 kg, J = diag[0.557, 0.557, 1.05] x lO'^kgm^ 

Five identical links with n = 5, mj = 0.1kg, and = 0.1m are considered. 
Controller parameters are selected as follows: kx = 12.8, = 4.22, kn = 0.65, 

kfi = 0.11, ki = 1.5, Cl = C2 = 0.7. Also kq and k^ are dehned as 

kg = [11.01, 6.67, 1.97, 0.41, 0.069], 
k^ = [0.93, 0.24, 0.032, 0.030, 0.025]. 

The desired location of the quadrotor is selected as Xd = Osxi. The initial 
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ity error for links 
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(c) Quadrotor angular velocity 0 :blue, (d) Control force u 

fld'-Ted 
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(e) Quadrotor position 



t 


(f) Quadrotor velocity 


Figure 9: Stabilization of a payload connected to a quadrotor with 5 links without 
Integral term 
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conditions for the quadrotor are given by 


a;(0) = [0.6;-0.7;0.2], i;(0) = Osxi, 

R{0) = /sxS) f^(0) = Osxi- 

The initial direction of the links are chosen such that the cable is curved along 
the horizontal direction, as illustrated at Figure 11(a), and the initial angular 
velocity of each link is chosen as zero. The following two hxed disturbances 
are included in the numerical simulation. 

= [0.03,-0.02,0.01]'^, 

= [-0.0125,0.0125,0.01]^. 

We considered two cases for this numerical simulation to compare the effect 
of the proposed integral term in the presence of disturbances as follows: (i) 
with integral term and (ii) without integral term, to emphasize the effect of the 
integral term. The simulation results for each case are illustrated at Figures 9 
and 10, respectively. The corresponding maneuvers of the quadrotor and the 
links for the second case are illustrated at Figure 11. 

Figures 9(a) and 10(a) show the attitude error function dehned as 

^P{R,Rd) = ltT[[I-R^R]], ( 68 ) 

which represents the difference between the desired attitude and the actual 
attitude of the quadrotor. It is shown that there is a steady state error for 
the hrst case without the integral control term, but the error is eliminated 
at Figure 10(a) for the second case. Next, we define the two following error 
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(a) Attitude error function ip 
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(b) Direction error Cq and angular veloc¬ 
ity error e^j for links 



(c) Quadrotor angular velocity D:blue, 
Drfired 



t 


(d) Control force u 




(e) Quadrotor position (f) Quadrotor velocity 

Figure 10: Stabilization of a payload connected to a quadrotor with 5 links with 
Integral term 
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cumulative variables to show the stabilizing performance for all links: 

n n 

eg = X] Iki - Call, e^ = ^||a;i||, (69) 

i=l i=l 

and the results of numerical simulation for these error functions are presented 
in 9(b) and 10(b) for each case. The initial errors for the links are quite large, 
but they converge to zero nicely. For the hrst case, there exist a small steady 
state error in both and e^. Figures 9(e) and 10(e) show the desired location 
of the quadrotor (dashed line) and the actual location (solid like) for each case. 

These numerical examples verihes that under the proposed control system, 
all of the position and attitude of the quadrotor, the direction of links, and the 
location of the payload asymptotically converge to their desire values, and the 
presented integral terms are effective in eliminating steady state errors caused 
by disturbances. 


44 








(f) t = 0.45 (g) t = 0.5 (h) t = 0.6 


(i) t = 0.7 


(j) t = 0.8 



Figure 11: Snapshots of the controlled maneuver 
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Chapter 4: Multiple Quadrotor UAVs Transporting a Rigid Body 


There are various applications for aerial load transportation such as usage in con¬ 
struction, military operations, emergency response, or delivering packages. Load 
transportation with the cable-suspended load has been studied traditionally for a he¬ 
licopter [5, 6] or for small unmanned aerial vehicles such as quadrotor UAVs [7, 8, 9]. 

In most of the prior works, the dynamics of aerial transportation has been sim- 
plihed due to the inherent dynamic complexities. For example, it is assumed that 
the dynamics of the payload is considered completely decoupled from quadrotors, 
and the effects of the payload and the cable are regarded as arbitrary external forces 
and moments exerted to the quadrotors [11, 12, 13], thereby making it challenging 
to suppress the swinging motion of the payload actively, particularly for agile aerial 
tr ansp ort at ions. 

The complete dynamic model of an arbitrary number of quadrotors transporting 
a rigid body presented in this chapter where each quadrotor is connected to the rigid 
body via a flexible cable. Each flexible cable is modeled as an arbitrary number of 
serially connected links, and it is valid for various masses and lengths. A coordinate 
free form of equations of motion is derived according to Lagrange mechanics on a 
nonlinear manifold for the full dynamic model. These sets of equations of motion are 
presented in a complete and organized manner without any simplihcation. 

Another contribution of this chapter is designing a control system to stabilize 
the rigid body at desired position. Geometric nonlinear controllers is utilized [41, 
28, 45], and they are generalized for the presented model. More explicitly, we show 
that the rigid body payload is asymptotically transported into a desired location, 
while aligning all of the links along the vertical direction corresponding to a hanging 
equilibrium. 

The unique property of the proposed control system is that the nontrivial coupling 
effects between the dynamics of rigid payload, flexible cables, and multiple quadro- 
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62 


63 

Figure 12: Quadrotor UAVs with a rigid body payload. Cables are modeled as a 
serial connection of an arbitrary number of links (only 4 quadrotors with 5 links in 
each cable are illustrated). 


tors are explicitly incorporated into control system design, without any simplifying 
assumption. Another distinct feature is that the equations of motion and the control 
systems are developed directly on the nonlinear conhguration manifold intrinsically. 
Therefore, singularities of local parameterization are completely avoided to generate 
agile maneuvers of the payload in a uniform way. In short, the proposed control 
system is particularly useful for rapid and safe payload transportation in complex 
terrain, where the position of the payload should be controlled concurrently while 
suppressing the deformation of the cables. 

This chapter is organized as follows. A dynamic model is presented and the 
problem is formulated at Section 4.1. Control systems are constructed at Sections 4.2 
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and 4.3, which are followed by numerical examples in Section 4.4. 

4.1 Quadrotor Dynamic Model 

Consider a rigid body with mass mo G M and moment of inertia Jq G 
being transported with arbitrary n numbers of quadrotors. The location of the 
mass center of the rigid body is denoted by xq G and its attitude is given 
by Rq G so( 3), where the special orthogonal group is given by SO(3) = {R G 
1 ^ 3 x 3 I jR" clet(i?) = 1}. Figure 12 illustrates the system with an inertial 
frame. We choose an inertial frame {ci, 62 , 63 } and body fixed frame {bi, 62 , ^ 3 } 
attached to the payload. We also consider a body hxed frame attached to the 
i-th quadrotor { 61 ., & 2 i, & 3 i}- In the inertial frame, the third axes 63 points 
downward with gravity and the other axes are chosen to form an orthonormal 
frame. 

The mass and the moment of inertia of the i-th quadrotor are denoted by 
mj G M and J* G respectively. The cable connecting each quadrotor to 
the rigid body is modeled as an arbitrary numbers of links for each quadrotor 
with varying masses and lengths. The direction of the j-th link of the i- 
th quadrotor, measured outward from the quadrotor toward the payload is 
dehned by the unit vector qij G S^, where S^ = {g G | ||g|| = 1}, where 
the mass and length of that link is denoted with rriij and respectively. The 
number of links in the cable connected to the Tth quadrotor is dehned as n*. 

The conhguration manifold for this system is given by SO(3) X X 
(S0(3)") X The i-th quadrotor can generate a thrust force of 

—fiRiCs G with respect to the inertial frame, where /j G M is the total 
thrust magnitude of the f-th quadrotor. It also generates a moment Mj G 
with respect to its body-hxed frame. Throughout this chapter, the two norm 
of a matrix A is denoted by ||4||. The standard dot product is denoted by 
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X ■ y = x^y for any x,y G 


4.1.1 Lagrangian 

The kinematics equations for the links, payload, and quadrotors are given by 


Qij ^ij ^ Qij ^ij Qij 1 

Rq = 

Fti 


(70) 

(71) 

(72) 


where Uij G is the angular velocity of the j-th link in the f-th cable satisfying 
Qij ■ Uij = 0. Also, ^ is the angular velocity of the payload and 12* G 
is the angular velocity of the f-th quadrotor, expressed with respect to the 
corresponding body hxed frame. The hat map ": —)■ 5o(3) is dehned by the 

condition that xy = x x y for all x,y & and the inverse of the hat map is 
denoted by the vee map V ; 5o(3) —)■ 

The position of the Tth quadrotor is given by 

rii 

(^0 T RoPi ^ ^ ^iaQiai ('^^) 

a=l 

where pi G is the vector from the center of mass of the rigid body to the 
point that f-th quadrotor is connected to rigid body via the cable. Similarly 
the position of the j-th link in the cable connecting the f-th quadrotor to the 
rigid body is given by 

rii 

Xij Xq T RoPi ^ ^ liaQia- 

a=j+l 

We derive equations of motion according to Lagrangian mechanics. Total 
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kinetic energy of the system is given by 


T =^mo\\xof + 

i=l j=l 2=1 

1 n ^ 

+ 2 + 2^0 ' 'Jo^o- 

2=1 

The gravitational potential energy is given by 

n n rii 

V = -moges ■ xq-'^ rriiges ■ Xi - EE rriijge^ ■ Xij, (76) 

2=1 2=1 Jl = l 

where it is assumed that the unit-vector 63 points downward along the gravi¬ 
tational acceleration as shown at Figure 12. The corresponding Lagrangian of 
the system is L = T — V. 

4.1.2 Euler-Lagrange equations 

Coordinate-free form of Lagrangian mechanics on the two-sphere and the 
special orthogonal group SO(3) for various multi-body systems has been stud¬ 
ied in [61, 62], The key idea is representing the inhnitesimal variation of 
Ri G SO(3) in terms of the exponential map 

Riexp^efji) = Rifii, (77) 

e=0 

for r]i G The corresponding variation of the angular velocity is given by 
(JOj = fji + Qi X rji. Similarly, the inhnitesimal variation of qij G S^ is given by 

^Qij ^ij ^ Qij: 

for ^ij G satisfying = 0. This lies in the tangent space as it 

is perpendicular to Using these, we obtain the following Euler-Lagrange 
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equations. 


Proposition 8 By using the above expressions, the equations of motion can he ob¬ 
tained from Hamilton’s principle: 


n Tii n 

MtXo — EE -^Oij ^ij Qij E MiTRoPi^o 

2=1 j = l 2=1 

n n 

= Mxges + —fiRiC^ — MixRoCllpi, 
2=1 2=1 

n n rii 

Jq^o + MiTpiR^Xo — EE PiRq Qij 

2=1 2 = 1 j=l 

n 

= piRi^{—fiRiC^ + MiTge^) — CIqJq^Iq, 

2=1 

Hi 

^ ^ HfQijlikQijQik ^OijPijXo R ^OijgijRoPi^O 
k=l 

= MoijplRonlpi - q^iMoijges - fiRiCs), 

“h X = -^^2* 


(79) 


(80) 


(81) 

(82) 


Here the total mass Mt of the system and the mass of the i-th quadrotor and its 
flexible cable Mix are defined as 

n rii 

Mr = mo + ^ MiT, Mix = ^ m*j + m*, (83) 

i=l j=l 

and the constants related to the mass of links are given as 

j-i 

Moij = m* + ^ mia, (84) 

a=l 

The equations of motion can he rearranged in a matrix form as follow 


NX = P 


(85) 
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where the state vector X G with Dx = 6 + 3 given by 


X — [xq, f 2 o; Qlj, g 2 j, ■ ■ ■ , Qnj]'^, 


(86) 


and matrix N G is defined as 


Mj'I^ 


NxqI 

Nxo2 ■ ■ 

■ N 

^ XqU 

Nf2oa:o 

Jo 

Nf2ol 

Nno2 ■ ■ 


Nlxo 

Nif2o 

Nqql 

0 

0 

^2x0 

N2f2o 

0 

Ngg2 ■ ■ 

0 

N 

■*■ ^ nxQ 


0 

0 

■ N 

-*- ’ qqn 


where the sub-matrices are defined as 

n 

NxoQo = ~ X] MiTRoPi] Nooajo = 
i=l 

N^oi = —[MoiiliiR, MQi2li2R-, ■■■ , MQinfiinJfii-, 

Nqqj [iWoil^ilPj-^O 1 i ' ' ' i ^OinfiiniPiRQ\i 

Nia;g = -^ 0 i 2 ?i 2 ) ' ' ' ) ^OiniQim] ) 

NiHo = [Moiiq^iRoPi, MQi2q^2^0Pi-, ■ ■, 


and the sub-matrix Nqqi G M^nixSni 

is given by 



1 

1 

CO 

Moi2li2q‘i2 

^OlruhnSim 

N ■ = 

XIo2ihiqli 

—Mo22h2h ■ ■ 

^02njiniqini 


Mori.lklQil 

Moni2k2qi2 ■ ■ 

-^Onini^irhi^S 


(87) 


( 88 ) 


(89) 
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The P G matrix is 


P — [PxQ, Pqo^ Pii) P2j, ■ ■■ , Pi 


nji 


( 90 ) 


and sub-matrices o/P matrix are also defined as 

n n 

Pxo = Mrges + MiTRo^lpi, 

i=\ i=l 

n 

Pqo ~ PiPp {MjTgG^ — fiRiGs), 

i=l 


Pij — ~ Qij{~fiPi^3 + Moijd^s) + PIoijQ^jRo^'oPi + Qij ■ 


Proof 8 See Appendix A.8 

These equations are derived directly on a nonlinear manifold without any sim- 
plihcation. The dynamics of the payload, flexible cables, and quadrotors are 
considered explicitly, and they avoid singularities and complexities associated 
to local coordinates. 

4.2 Controlled System Design for Simplified Dynamic Model 

Let xq^ G be the desired position of the payload. The desired attitude of 
the payload is considered as Rq^ = /sxs, and the desired direction of links is 
aligned along the vertical direction. The corresponding location of the i-th 
quadrotor at this desired configuration is given by 

Ui 

^id = Pi-'^ haGs- ( 91 ) 

a=l 

We wish to design control forces /* and control moments Mi of quadrotors 
such that this desired configuration becomes asymptotically stable. 
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4.2.1 Simplified Dynamic Model 


Control forces for each quadrotor is given by —fiRiC^ for the given equations 
of motion (79), (80), (81), (82). As such, the quadrotor dynamics is under¬ 
actuated. The total thrust magnitude of each quadrotor can be arbitrary 
chosen, but the direction of the thrust vector is always along the third body 
fixed axis, represented by Rie^. But, the rotational attitude dynamics of the 
quadrotors are fully actuated, and they are not affected by the translational 
dynamics of the quadrotors or the dynamics of links. 

Based on these observations, in this section, we simplify the model by 
replacing the —fiRiC^ term by a fictitious control input Wj G and design an 
expression for u to asymptotically stabilize the desired equilibrium. In another 
words, we assume that the attitude of the quadrotor can be instantaneously 
changed. The effects of the attitude dynamics are studied at the next section. 

4.2.2 Linear Control System 

The control system for the simplified dynamic model is developed based on the 
linearized equations of motion. At the desired equilibrium, the position and 
the attitude of the payload are given by Xq^ and Rq = I 3 , respectively, where 
the superscript * denotes the value of a variable at the desired equilibrium 
throughout this paper. Also, we have q*j = 63 and R* = 13 . In this equilibrium 
configuration, the control input for the Ath quadrotor is 

< = -/;i?:e3, (92) 

where the total thrust is f* = + ^)g- 
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The variation of Xq is given by 


5xo = Xq-Xo^, (93) 

and the variation of the attitude of the payload is defined as 

5Rq = Rlfjo = J7o, 

for ? 7 o G The variation of qij can be written as 

X 63 , (94) 

where ^ij G with ^ij -63 = 0. The variation of Uij is given by 6 uij G 
with 6uij ■ 63 = 0. Therefore, the third element of each of ^ij and 6uij for 
any equilibrium conhguration is zero, and they are omitted in the following 
linearized equations. The state vector of the linearized equation is composed 
of C^^ij G where C = [ci, 62 ] G The variation of the control input 

6ui G is given as 6ui = Ui — u*. 

Proposition 9 The linearized equations of the simplified dynamie model are given 
by 

Mx + Gx = B(5 m, (95) 

where the state vector x G with Dy^ = 6 + 2 given by 
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and Su = [5u\, Su 2 , ■ ■ ■ , G The matrix M G are defined as 




Ma;gl 

Ma;Q2 ■ ■ 

]^a;on 

MQqXO 

Jo 

MqqI 

0 

to 

■ Mqqh 

Mia-g 

Miqq 

Mggl 

0 

0 

M2a;o 

M 2 Q 0 

0 

Mqg2 ■ ■ 

0 

■l^nxo 


0 

0 

^^qqn 


where the sub-matriees are defined as 

n 

= -y^MiTPi] Moga-g = 
i=l 

1 •) " " " 5 -^Oifii^irii dsC], 

l^-ddoiiliiPiC, MQ^2h2PiC, ' ' ' 1 ^iniPiC*]) 

= —[MoiiC'^Cs, MQi2C'^e^, ■■■ , MQin^C'^efi\1 (96) 

MjQg = [M^iiC'^e^pi, M^aC'^e^Pi, •■■ , M^irnC'^e^pj\, (97) 


and the sub-matrix Mg^j ( 

— jg^2njX2ni 

is given by 




Miiihih 

Mii2li2l2 

1 

■i^ 


Mgg, = 

Mi2lhll2 

Mi22k2l2 ■ ■ 

-^i2ni^ini^2 

(98) 


dJinillill2 

Mini2h2l2 ■ ■ 

1 

■S 
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The matrix G G is defined as 


0 0 0 

0 0 0 

0 0 0 

G 2 0 0 ’ 

0 0 Gn 

where Gq^Qq = ^ 9 Pi ^3 ^he sub-matriees Gj G M 2 nix 2 ni 

Gj = diag[(—MjT’ —— + MQij)ge3l2]- 
The matrix B G is given by 

h ■ ■ ■ h 

P2 ■ ■ ■ Pn 

0 0 0 

Bb 0 0 ’ 

[ 0 0 0 Bb 

where Bb = — [G^es, G^es, ■ ■ ■ , C'^efifi'. 

Proof 9 See Appendix A.9 

We present the following PD-type control system for the linearized dynamics 

5ui = — Kxpx. — (99) 

for controller gains Kx^,Kx^ G Provided that (95) is controllable, 


h 

Pi 

Be 

0 


G = 


0 0 0 

0 GqqJ7q 0 

0 0 Gi 

0 0 0 

0 0 0 
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we can choose the combined controller gains ... = 

... K'^J^ G M^nxDx ^liat the equilibrium is asymptotically stable 
for the linearized equation (95). 

4.3 Controlled System Design for Full Dynamic Model 

The control system designed at the previous section is based on a simplifying 
assumption that each quadrotor can generates a thrust along any direction. 
In the full dynamic model, the direction of the thrust for each quadrotor is 
parallel to its third body-fixed axis always. In this section, the attitude of each 
quadrotor is controlled such that the third body-hxed axis becomes parallel 
to the direction of the ideal control force designed in the previous section. 
The central idea is that the attitude Ri of the quadrotor is controlled such 
that its total thrust direction —RiCs, corresponding to the third body-fixed 
axis, asymptotically follows the direction of the hctitious control input Ui. By 
choosing the total thrust magnitude properly, we can guarantee asymptotical 
stability for the full dynamic model. 

Let Ai G be the ideal total thrust of the Tth quadrotor that asymptot¬ 
ically stabilize the desired equilibrium. Therefor, we have 

Ai = u* + 5ui =Ki,.± +u*, ( 100 ) 

where f* and u* are the total thrust and control input of each quadrotor at 
its equilibrium respectively. 

From the desired direction of the third body-fixed axis of the Tth quadrotor, 
namely 63 . G S^, is given by 
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This provides a two-dimensional constraint on the three dimensional desired 
attitude of each quadrotor, such that there remains one degree of freedom. 
To resolve it, the desired direction of the first body-hxed axis bi^(t) G is 
introduced as a smooth function of time. Due to the fact that the hrst body- 
hxed axis is normal to the third body-hxed axis, it is impossible to follow 
an arbitrary command bi-{t) exactly. Instead, its projection onto the plane 
normal to 63 ^ is followed, and the desired direction of the second body-hxed 
axis is chosen to constitute an orthonormal frame [28]. More explicitly, the 
desired attitude of the Tth quadrotor is given by 


Rj 




( 102 ) 


which is guaranteed to be an element of 5 o( 3 ). The desired angular velocity is 
obtained from the attitude kinematics equation, G Dehne 

the tracking error vectors for the attitude and the angular velocity of the i-th 
quadrotor as 


iR, = - RjRi,Y, ea, = fti - RjRiSli., 


(103) 


and a conhguration error function on SO(3) as follows 


% = -tr|D/ - RjR. 


(104) 


The thrust magnitude is chosen as the length of Ui, projected on to —Rie^, 
and the control moment is chosen as a tracking controller on SO(3); 


h 

M, 


■ Ri^Si 

- kRCR^ - knen^ + {RJRc^aTRRJRcPa + RRf Rc^k^a, 


59 


(105) 

(106) 



where and /cq are positive constants. Stability of the corresponding con¬ 
trolled systems for the full dynamic model can be studied by showing the the 
error due to the discrepancy between the desired direction 63 . and the actual 
direction RiC^. This stability is shown via a Lyapunov analysis. 

Proposition 10 Consider the full dynamie model defined by (79), (80), (81), (82). 
For the command xq^ and the desired direction of the first body-fixed axis hl^, control 
inputs for quadrotors are designed as (105) and (106). Then, the equilibrium of zero 
tracking errors for e^^, e^o, cr^, euo, e^.., cr., cq., is exponentially stable. 

Proof 10 See Appendix A. 10 

4.4 Numerical Example 

We demonstrate the desirable properties of the proposed control system with 
numerical examples. Two cases are presented. At the first case, a payload is 
transported to a desired position from the ground. The second case considers 
stabilization of a payload with large initial attitude errors. 

4.4.1 Stabilization of the Rigid Body 

Consider four quadrotors (n = 4) connected via flexible cables to a rigid body 
payload. Initial conditions are chosen as 

a;o(0) = [1.0, 4.8, 0.0]'^m, no(0) = Osxi, 

Q'P'(O) = 63, U}ij{ 0 ) = O3XI, Ri{ 0 ) = / 3 x 3 ) = O3XI 

-Ro(O) = IsxS, = O 3 XI. 

The desired position of the payload is chosen as 

xofit) = [0.44, 0.78, -0.5]^ m. (107) 
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The mass properties of quadrotors are chosen as 


rrii = 0.755 kg, 

Ji = diag[0.557, 0.557, 1.05] x lO'^kgm^. (108) 

The payload is a box with mass mo = 0.5 kg, and its length, width, and height 
are 0.6, 0.8, and 0.2 m, respectively. Each cable connecting the rigid body to 
the i-th quadrotor is considered to be = 5 rigid links. All the links have the 
same mass of mij = 0.01 kg and length of = 0.15 m. Each cable is attached 
to the following points of the payload 

= [0.3, -0.4, -0.1]^ m, p 2 = [0.3, 0.4, -0.1]^ m, 

P 3 = [-0.3, -0.4, -0.1]^m, p 4 = [-0.3, 0.4, -O.lj^m. 

Numerical simulation results are presented at Figure 13, which shows the 
position and velocity of the payload, and its tracking errors. We have also 
presented the link direction error dehned as 

m rii 

eg = 5^5^lkp-e3||. 

i=l j=l 
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(a) Payload position (a:o:blue, a;orf:red) 



(c) Payload angular velocity V,q 



(e) Payload attitude error 4'o 



(g) Quadrotors total thrust inputs fi 



t 


(b) Payload velocity (no:blue, uo^ired) 



t 


(d) Quadrotors angular velocity errors 



t 


(f) Quadrotors attitude errors 



(h) Direction error , and angular veloc¬ 
ity error Cu; for the links 


Figure 13: Stabilization of a rigid-body connected to multiple quadrotors 
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(a) 3D perspective 




(c) Top view 


Figure 14: Snapshots of controlled maneuver 
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4.4.2 Payload Stabilization with Large Initial Attitude Errors 


In the second case, we consider large initial errors for the attitude of the 
payload and quadrotors. Initially, the rigid body is tilted in its hi axis by 30 
degrees, and the initial direction of the links are chosen such that two cables 
are curved along the horizontal direction. The initial conditions are given by 

a;o(0) = [2.4, 0.8, -1.0]^, no(0) = Ogxi, 

|^p(0) = Osxi, hli(O) = Osxi 
-Ro(O) = i?a;(30°), hlo = Osxl, 

where i?a;(30°) denotes the rotation about the hrst axis by 30°. The initial 
attitude of quadrotors are chosen as 

-Ri(O) = i?y(—35°), i?2(0) = /sxs, 

-^ 3 ( 0 ) = i?y( —35°), i?4(0) = / 3 x 3 - 

The properties of quadrotors and cables are identical to the previous case. 
The payload mass is m = 1.0 kg , and its length, width, and height are 1.0, 
1.2, and 0.2 m, respectively. Figure 15 illustrates the tracking errors, and the 
total thrust of each quadrotor. Snapshots of the controlled maneuvers is also 
illustrated at Figure 16. It is shown that the proposed controller is able to 
stabilize the payload and cables at their desired conhguration even from the 
large initial attitude errors^. 


short animation of this numerical simulation is available at http://youtu.be/jl4tSuHd8oA. 
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(a) Payload position a:o:blue, a;orf:red (b) Payload velocity i;o:blue, tiOi:red 



*0 2 4 6 8 10 

t 


(c) Payload angular velocity Hq 



t 


(e) Payload attitude error tpQ 



t 


(g) Quadrotors total thrust inputs fi 



0.4 

0.2 


° 10 20 30 40 50 

(d) Quadrotors angular velocity errors 

esii 



(f) Quadrotors attitude errors 



(h) Direction error e^, and angular veloc¬ 
ity error for the links 


Figure 15: Stabilization of a payload with multiple quadrotors connected with flexible 
cables. 65 
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(d) t = 0.68 Sec. 


(e) t = 1.10 Sec. 


(f) t = 1.36 Sec. 



(g) t = 1.98 Sec. 



(h) t = 3.48 Sec. 



Figure 16: Snapshots of the controlled maneuver. 
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4.4.3 Two Quadrotors Stabilizing a Rod 


The results of this chapter can be specialized to the following system. Consider 
two quadrotors transporting a rod to a hxed position as shown in Figure 17. 


mi, Ji,xi 


Qiul 


11 


m2, J2,X2 


Q21, I 


21 

" 121 , 2:21 

mii,Xii "^ 0 , 2 : 0 , go 
Figure 17: Two quadrotor with a rod 


We compare stabilization of the rod with large initial attitude errors both 
for quadrotors and rod for two cases of with and without the integral term in 
presence of the hxed disturbances in both rotational and translational dynam¬ 
ics. 

The results of this numerical simulation is presented in Figure 18 and 19 
for without and with integral cases respectively. Snapshots of this maneuver 
with the integral term is also illustrated at Figure 20. 
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(a) Rod position xo:blue, xo^:red 




(c) Link errors e^,eg 
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(e) Quads angular velocity errors 
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(b) Rod velocity uo:blue, uo^:red 



0 2 4 6 8 10 

(d) Total Thrust fi 



(f) Quads attitude errors 


Figure 18: Stabilization of a rod with two quadrotors without Integral term. 







































(a) Rod position ccoiblue, a;o^:red (b) Rod velocity i;o:blue, i;od:red 





(e) Quads angular velocity errors Cui (f) Quads attitude errors ipi 


Figure 19: Stabilization of a rod with two quadrotors with Integral term. 
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(a) t = 0 Sec. 



n 


< 

(b) t = 0.14 Sec. 



H' 

< 

(c) t = 0.30 Sec. 




(f) t = 1.36 Sec. 




(h) t = 3.48 Sec. 

Figure 20: Snapshots of the controlled maneuver for two quadrotors stabilizing a rod. 
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Chapter 5: Experiment 


We develop an experimental testbed with qnadrotor UAV’s to validate onr derivations 
and simnlations. Two qnadrotor UAV’s are bnilt from scratch by designing every 
parts followed by developing a software for real-time experiments. The hardware and 
software development for the experimental part of this dissertation is presented in the 
following. Finally, the experimental resnlts for some aggressive trajectory tracking 
and payload transportation are provided. 


5.1 CAD Model and Calibration 


We developed an accnrate CAD model as shown in Fignre 21(a) to identify 
several parameters of the qnadrotor, snch as moment of inertia and center of 
mass. Fnrthermore, a precise rotor calibration is performed for each rotor, 
with a cnstom-made thrnst stand as shown in Fignre 21(b) to determine the 
relation between the command in the motor speed controller and the actnal 
thrnst. For varions valnes of motor speed commands, the corresponding thrnst 
is measnred, and those data are htted with a second order polynomial. 



(a) CAD Model 


(b) Motor cali¬ 
bration setup 


Fignre 21: Hardware development for a qnadrotor UAV 
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5.2 Building Quadrotor 


The quadrotor UAV developed at the flight dynamics and control laboratory 
at the George Washington University is shown at Figure 22. The angular 
velocity is measured from inertial measurement unit (IMU) and the attitude 
is obtained from IMU data. Position of the UAV is measured from motion 
capture system (Vicon) as shown in Figure 23 and the velocity is estimated 
from the measurement. Ground computing system receives the Vicon data and 
send it to the UAV via XBee. The Gumstix is adopted as micro computing 
unit on the UAV. 



via UART 


Figure 22: Hardware development 



Figure 23: Motion capture Laboratory 
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5.2.1 Hardware Configuration 


Quadrotor is built using several parts as listed bellow. The motors are con¬ 
nected to the circuit board via speed controllers and I2C ports. The IMU 
is connected to the circuit board via serial ports and the computer module 
(GUMSTIX) handles the communications and controller computation. 

• Gumstix Overo computer-in-module (OMAP 600MHz processor), running a 
non-realtime Linux operating system. It is connected to a ground station via 
WIFI (Figure 24(c)). 

• Microstrain 3DM-GX3 IMU, connected to Gumstix via UART (Figure 24(b)). 

• BL-GTRL 2.0 motor speed controller, connected to Gumstix via I2G (Fig¬ 
ure 25(a)). 

• Roxxy 2827-35 Brushless DG motors (Figure 25(b)). 

• XBee RF module, connected to Gumstix via UART. (Figure 24(a)) 



(a) XBee 


(b) IMU 


(c) Computer Module 


Figure 24: Hardware parts for a quadrotor UAV 


Finally, these parts are all connected to the circuit board which has been 
custom designed and built for the experiment as illustrated in Figure 26 and 
two quadrotors are prepared for the experiments as shown in Figure 27. 
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(a) Motor speed controller (b) Brushless DC motors 

Figure 25: Motors and speed controllers 



Figure 26: Hardware connections 


5.2.2 Software Development 

Multi-threaded programming with C/C-I--I- utilized to develop a complete and 
fast software which runs on the computer module and handles several tasks. 
It has three main threads, namely Vicon thread, IMU thread, and control 
thread. The Vicon thread receives the Vicon measurement and estimates linear 
velocity of the quadrotor. The IMU thread receives the IMU measurement and 
estimates the attitude. The last thread handles the control outputs at each 
time step. Also, control outputs are calculated at 120Hz which is fast enough 
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(a) Quadrotor 1 (b) Quadrotor 2 

Figure 27: Quadrotors 

to run any kind of aggressive maneuvers. Information flow of the system is 
illustrated in Figures 28 and 29. 



Figure 28: Information flow of overall system 



Figure 29: Information flow of overall system 

We also need to tune the proportional, derivative, and integral gains for 
the experiment. By using the numerical simulation, we are able to hnd an 
estimate for this gains but they need to be tuned during the experiment in 
order to get the best performance of the controller. 
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5.3 Autonomous Trajectory Tracking 
5.3.1 Attitude Tracking Test 

Experimental results are provided for the attitude tracking control of a hard¬ 
ware system developed in FDCL. To test the attitude dynamics, it is attached 
to a spherical joint. As the center of rotation is below the center of gravity, 
there exists a destabilizing gravitational moment, and the resulting attitude 
dynamics is similar to an inverted rigid body pendulum. The control input is 
augmented with an additional term to eliminate the effects of the gravity. 

The desired attitude command is described by using 3-2-1 Euler angles, 
i.e. Rd{t) = Rd{(j){t),0{t),'ijj{t)), where (j){t) = |sin(7rf), 6{t) = |cos(7rf), 
= 0. This represents a combined rolling and pitching motion with a 
period of 2 seconds. The results of the experiment are illustrated at Figures 
30 and 31. 



(a) Attitude error function 
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(b) Attitude R, Rd 
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(d) Thrust of each rotor (N) 


(c) Angular velocity fid (/sec) 

Figure 30: Attitude tracking test(dotted:desired, solid:actual) 
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Figure 31: Quadrotor on a stand 


5.3.2 Lissajous Curve Trajectory Tracking 

First, we consider a position tracking mode, where the desired trajectory is 
dehned as the following Lissajous curve. 



if 0 < t < 8 


[sin(f — 8) + |), sin2(f — 8), —1.5] m if 8 ^ f 


The quadrotor takes-off from Xo = [0.2, —2.8, —1.2]m at f = 0 sec and flies to 
the initial position of the Lissajous curve trajectory where is Xi = [1, 0, 1.5]m 
by tracking a linear desired trajectory. Then, the quadrotor starts to follow 
the Lissajous curve trajectory at t = 8 sec. There is about 0.15 sec of time 
delay from the Vicon motion capture system to the Gumstix. However, due 
to the robustness and stability properties of the proposed controller, position 
tracking performance shows satisfactory results as shown at Figure 33 and 32. 
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Figure 32: Lissajous curve x — y plane trajectory 

5.3.3 Flipping 360 Degree Maneuver 

Next, the proposed controller is validated with a flipping maneuver. The 
quadrotor takes off from a landing platform, increases altitude with constant 
speed to a constant point, flips 360 degree about it a:-axis. As presented in the 
numerical simulation section, this is a complex maneuver combining a nontriv¬ 
ial pitching maneuver with a yawing motion. It is achieved by concatenating 
the following two control modes of an attitude tracking same as presented in 
the numerical simulation to rotate the quadrotor 

Rd{t) = I + sin(47rt)er + (1 — cos(47rt))(ere^ — J), 12^ = Svr ■ e^. 

where = [1, 0, 0], and a trajectory tracking mode to make it hover after 
completing the preceding rotation. As it is clear from the hgures, the attitude 
control part which handles the rotation happens in almost 0.3 seconds and 
then it switched to the position control mode to make the quadrotor stabilized 
and hovers to the desired position. Figure 34 and 35 show the experimental 
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(c) Position (solid line) and desired (dot- (d) Linear velocity (m/sec) 
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(e) Eular angles (rad) 


(f) Angular velocity (rad/sec) 


Figure 33: Lissajous curve tracking(dotted:desired, solid:actual) 
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results and snapshots of the flipping maneuver respectively. 

There are several disturbances and modeling errors in this experimental 
setup, such as errors in mass properties of the quadrotor, processing and com¬ 
munication delay of the motion capture systems, and the dynamics of pro¬ 
pellers. Therefore, these experimental illustrate robustness of the proposed 
control system with respect to various forms of uncertainties and disturbances^. 


short video of the experiments is available at http://youtu.be/wtn9L6BsYiE. 
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z(m) y(m) x(m) 




(a) Attitude error variables en, ea (b) Thrust of each rotor (N) 



(c) Position x,Xd (m) 



(d) Linear velocity (m/sec) 



(e) Rotation Matrix 


(f) Angular velocity ft, fid (rad/sec) 


Figure 34: Flipping flight test results (dotted:desired, solidiactual) 
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(a) t = 0.0 sec 


(b) t = 0.8756 sec 


(c) t = 1.008 sec 



(d) t = 1.079 sec 


(e) t = 1.125 sec 


(f) t = 1.175 sec 


(g) t = 1.844 sec 



(h) t = 2.312 sec 


(i) t = 2.89 sec 


Figure 35: Snapshots for flipping maneuver. 




5.4 Payload Stabilization with one Quadrotor 

The weight of the entire UAV system is 0.791kg including one battery. A 
payload with mass of mi = 0.036 kg is attached to the quadrotor via a cable 
of length li = 0.7 m. The length from the center of the quadrotor to each motor 
rotational axis is d = 0.169m, the thrust to torque coefficient is Cr^ = 0.1056m 
and the moment of inertia is J = [0.56,0.56,1.05] x 10“^kgm^. 

Two cases are considered and compared. For the first case, a position 
control system developed in [45], for quadrotor UAV that does not include the 
dynamics of the payload and the link, is applied to hover the quadrotor at the 
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desired location, and the second case, the proposed control system is used. 

Experimental results are shown at Figures 36 and 38. The position of 
the quadrotor and the payload is compared with the desired position of the 
quadrotor at Figure 36, and the deflection angle of the link from the vertical 
direction are illustrated at Figure 38. It is shown that the proposed control 
system reduces the undesired oscillation of the link effectively, compared with 
the quadrotor position control system. ^ 

There are several disturbances and modeling errors in this experimental 
setup, such as errors in mass properties of the quadrotor, processing and com¬ 
munication delay of the motion capture systems, and ground effects of air 
flow. Therefore, these experimental illustrate robustness of the proposed con¬ 
trol system with respect to various forms of uncertainties and disturbances. 
Generalizing the presented control system for advanced nonlinear adaptive or 
robust controls are relegated to future investigation. 


short video of the experiments is available at http://youtu.be/RyTmWVbgt34. 
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(a) Case I: quadrotor position control system [45] 



—Quadrotor Position 


—Payload Position 

■ 



'^0 2 4 6 8 10 12 14 16 18 20 



(b) Case II: proposed control system for quadrotor with suspended 
payload 

Figure 36: Experimental results (x^iblack, x:red, x + /igiiblue) 
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Figure 37: Snapshot of a quadrotor UAV stabilizing a payload 



(a) Case I: quadrotor position control (b) Case II: proposed control system for 
system [45] quadrotor with suspended payload 


Figure 38: Experimental results: link deflection angles 
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Chapter 6: Conclusions 


We conclude our research and work of this dissertation here. In this section, hrst a 
summary of conclusions is given and it is followed by the future work. 

6.1 Conclusions 

A new nonlinear adaptive control system is proposed for tracking control of 
quadrotor unmanned aerial vehicles. It is developed directly on the special or¬ 
thogonal group to avoid complexities and ambiguities that are associated with 
Euler-angles or quaternions, and the proposed adaptive control term guaran¬ 
tees almost global attractively for the tracking error variables in the existence 
of uncertainties. 

Euler-Lagrange equations have been derived for multiple cooperative quadro¬ 
tor UAVs and the chain pendulum to model each flexible cable transporting 
a rigid body in 3D space. These derivations developed in a remarkably com¬ 
pact form which allows us to choose arbitrary number and any conhguration 
of the links. We developed a geometric nonlinear controller to stabilize the 
links below the quadrotor in the equilibrium position from any chosen initial 
condition. We expanded these derivations in such way that there is no need 
of using local angle coordinate. Rigorous mathematical stability proofs are 
given without any time-scale separation assumptions and these are verihed by 
mathematical analysis, numerical simulations, and experiments for aggressive 
maneuvers concurrently. 



6.2 Challenges & Future Work 


Several limitations and challenges are considered for the proposed dynamic 
model, controller and experimental testbed. Some of the limitations, impor¬ 
tant hardware challenges, and future directions are listed bellow 

• Communication is very important in real-time experiments. We need high 
speed update rate in order to maintain an aggressive maneuver, and any failure 
in communication causes instability of the system and would lead to incidents. 

• Batteries used for the experiment can play an important role in a successful 
maneuver. They can be drained very soon and it affects the performance of 
the hardware and the gain tuning process. 

• Different sensors are used in real-time experiments. For example, an IMU 
used to obtain the angular velocities, and Vicon Motion Capture system to 
obtain the position of the object. In both, sensors provide the noisy data 
which needed to be hltered or estimated to obtain smooth data. Furthermore, 
we experienced delay in receiving the data using the Vicon system. 

• The flexible cables are considered into the dynamic of the system by modeling 
them as serially connected links. As more as links get used in the cable, 
the dynamic model becomes more accurate. However, additional sensors are 
needed to measure the deformation of the cable accurately. 

• The proposed cable model via interconnected lumped masses is readily gen¬ 
eralized to uniform mass distribution at each link. Based on the assumption 
that the diameter of the cable is much smaller than its length, the torsion of 
the bending moment are not considered in this dissertation. 

• Payload stabilization with single and multiple quadrotor UAVs to a hxed po¬ 
sition are presented in this work. Dynamics model can be used and new 
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controller can be extended and designed for tracking time-varying trajecto¬ 
ries. 

Experimental results for payload trajectory tracking is another future direction 
of this dissertation. There are several challenges in running experiments with 
multiple quadrotors simultaneously and tracking a desired trajectory for a 
payload with multiple quadrotor UAV’s to validate the derivation for time- 
continuous controller. 

Future directions include extending this research in an outdoor environment 
to identify the wind effects and verifying the performance of the controller in 
various weather situations. A GPS system can be installed on the quadrotors 
instead of the Motion Capture system in a laboratory to identify the position 
and velocity of the quadrotor. 
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Appendix- Proofs 


A.l Proof for Proposition 1 

The proofs of (i)-(iii) are available at [55, (Chap. 11)]. To show (iv) and (v), let 
Q = R^R = exp a; G S0(3) for a; G from Rodrigues’ formula. Using the MATLAB 
Symbolic Computation Tool, we find 


Ileaiir 




1 — cos 



i9i + 9j)xl, 


(1 — COS ||a;||)^ 
4||a;||^ 


(9i-9jfxlx] + 

{i,j,k)£€ 



(9i + 9jfxl, 

{i,j,k)£€ 


where (f = {(1, 2,3), (2, 3,1), (3,1, 2)}. When T = 0, Eq. 12 is trivial. Assuming that 

II Il2 

T 7 ^ 0, therefore ||a;|| ^ 0, an upper bound of is given by 




< 7^(1 - COS \\x\\)h 2 + 7^(1 + cos ||a;||)h 3 < 

2/ii 2/ii 


^2 + hs 
hi 


which shows Eq. 12. 

Next, we consider (v). When T = 0, Eq. 13 is trivial. Hereafter, we assume 

T 7 ^ 0, therefore R 7 ^ Rd- At the three remaining critical points of T, the values of 

T are given by gi + g 2 , g 2 + gs, or g^ + gi. So, from the given bound T < '^, these 

three critical points are avoided, and we can guarantee that 7 ^ 0 and ||a;|| < tt. An 

upper bound of is given by 
I wJ? II 

T 2(l-cos||a;||) E£(^^ + ^j)a^fc/l|a^lP ^ 2 

||ep||2 “ sin||a;||2 + hj)‘^xl/\\x\\^ ~ 1 + cos\\x\\ 

Also, an upper bound of 2 — is given by 

1 — POS T /? 1 

hi — Ip < hi — < hi - - - -hi = “^(1 + cos ||a;||). (HO) 
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Substituting this into Eq. 109, we have 


'h ^ h^hi _ 

WcrW^ - hih - ij) ~ 

which shows Eq. 13. 

For a given tracking command {Rd, ^d), and current attitude and angular velocity 
(/?, n), we dehne an attitude error function d' : SO{3) x SO{3) E R as 

<HR,Ri)^^tr[I-RjR]. (Ill) 

The desired angular velocity can be written as follows 

(id = R^Rd. (112) 


We take the derivative to hnd the cr and en 

D^{R,Rd) = -]^tr[d{RlR)] = 


Using 

tr{xA) = tr[Ax] = ^tr[x{A — A^)] = —x^{A — A^’^Y ^ 


we can conclude 


We dehne 


and 


tYRlRff] = -viRdR - RdRYY 
D'^iR, Rd) ■ R^ = \{RlR - R^RdY ' h- 

eR = ^{RYR-R^RdY, 

^<1 — RdRd ^ Rd = Rd^d- 
98 


(113) 

(114) 

(115) 

(116) 

(117) 


( 118 ) 



So we can write and simplify the following equation to find the 

R - Rd{R^R) =Rn- RdCldRdR = R{^ - R^Rd^dR^R)- (119) 
Comparing the above equation with R = RQ, we can result in the following equation 

Gn = Cl — R^ RdCldR^R, ( 120 ) 

or 

Co = H — R^ Rd^d- (121) 

Now, we try to hnd an expression for d' by taking time-derivative of d/ 

= ( 122 ) 

Substituting R = Rfl and R^ = —CldRd into the above expression, we would have 

d/ = -^tr[-QdRdR + Rd^Cl], (123) 

and we can rewrite the above equation as follows 

* = leUn^R - ( 124 ) 

SO 

^ = eR ■ eo. (125) 
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A.2 Proof for Proposition 2 

We first find the error dynamics for e^j, cq, and define a Lyapunov function. Then, 
we hnd conditions on control parameters to guarantee the boundedness of tracking 
errors. Using (3), (4), (24), the time-derivative of Je^ can be written as 


Jcq — {Jcq -|- d}^en — kneji — + ^rOr, (126) 


where d = (2J - tT[J]I)R'^Rdkld G and 9r = Or - Or. The important property 
is that the first term of the right hand side is normal to and it simplihes the 
subsequent Lyapunov analysis. Dehne a Lyapunov function V 2 be 


1 1 ~ 

V 2 = -cq ■ JeQ, + Zc/j 'L(i?, Rd) + C2eR ■ Jen + -— 

2 2'yR 


(127) 


From (12), (13), the Lyapunov function V 2 is bounded as 


Z2M21Z2 + --^ 1^2 < Z2M22Z2 + 7^- 

27r 27ij 


(128) 


where Z 2 = [||eR||, ||en||]'^ G and the matrices M 2 i,M 22 are given by 


M 21 — - 

kR 

— C2^M 

, M 22 — - 

2kii 

2—1p2 

C2AM 

2 

—C2^M 


2 

C2^M 

Am 


(129) 


From (13), the upper-bound of (128) is satished in the following domain: 


D 2 = {{R, n) G S0(3) X I < ^2 < 2}. (130) 
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From (14), (230), the time derivative of V 2 along the solution of the controlled system 
is given by 

V 2 = — A;n||ef2|P + + C2eR ■ Jcq + 026 /? ■ Jcq H- (9)^(9). 

IR 

We have 9^ = —9r. Substituting (230), the above equation becomes 


V 2 — — + C2eR ■ JeQ — C2/i:_R||eij|p 

+ C2eR ■ {{Jen + d)'"en - k^e^) 

+ ^RW^(en + 026^)- 

IR 

By substituting the adaptive law given by (16) 


V2 — — /co||eo||^ + C 2 epi ■ Jen — C 2 A;/j||eij||^ + 026/? ■ {{Jen + d)^en — knen)- 


Since ||eR|| < 1, ||eij|| < ||eQ||, and ||d|| < B 2 , we have 

V 2 ^ ~^JhF2^2; 


(131) 


where the matrix hF 2 G is given by 


1^2 


C2kR -'f{kn + B2) 
— %{knJB2) kn — 2c2XM 


The condition on C 2 given at (237) guarantees that all of matrices M 21 , W 2 are positive 
definite. According to the LaSalle-Yoshizawa theorem [65, Theorem A.8], this implies 
that the zero equilibrium of tracking errors and the estimation error is stable in the 
sense of Lyapunov, and eR, —)■ 0 as t —)■ cx). Furthermore 9r is uniformly bounded. 
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A.3 Proof for Proposition 3 


We derive the tracking error dynamics and a Lyapunov function for the translational 
dynamics of a quadrotor UAV, and later it is combined with the stability analysis of 
the rotational dynamics. The subsequent analysis are developed in the domain Di 

Di = {{ea;, e^, R, cq) e x x S0(3) x | 

l|ea;|| < T < < 1}, (132) 

Similar to (13), we can show that 

tyesf (133) 

a) Translational Error Dynamics 

The time derivative of the position error is e^, = e„. The time-derivative of the velocity 
error is given by 

me„ = mx — mxd = mge^ — fRe^ — mxd + (134) 

Consider the quantity e^R^Re^, which represents the cosine of the angle between 
63 = Res and 63^ = RcCs- Since 1 — 'L(i?, i?c) represents the cosine of the eigen-axis 
rotation angle between R^ and R, we have e^R^Re^ > 1 — 4 /(i?, i?c) > 0 in Di. 
Therefore, the quantity is well-dehned. To rewrite the error dynamics of 

in terms of the attitude error cr, we add and subtract RcGs to the right hand 

side of (134) to obtain 


mey = mges — mXd — 


f 

ejR^Res 


Rc ^3 — X + VJ^Ox: 


(135) 
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where X G is defined by 


- R^e^). (136) 

Let A = —k^e^ — k^e^ — W^Ox — mge^ + mxd- Then, from (21), (23), we have 
63 ^ = -RcCs = —A/ ||yl|| and / = —A ■ Re^. By combining these, we obtain / = 
(IIAII -RcCs) ■ -Res- Therefore, the third term of the right hand side of (135) can be 
written as 


/ 


elR^Re: 


~ Rc^3 


(||A||R,e3)-/2e3 A 


e'^RTRe^ 


= A 


kx(^x 


kv^v 


WxOx 


mges + mXd- 


Substituting this into (135), the error dynamics of can be written as 

mex = — kxCx — kyCy — WxOx — X + WxOx 

= -kxCx - kyCy + WxOx - X. (137) 

where Ox = Ox — Ox is the estimation errors. 

b) Lyapunov Candidate for Translation Dynamics 

Let a Lyapunov candidate Vi be 

Vi = l:kx\\ex\\^ + l^mWeyW^ + cic^, ■ mey + ^WOxW^. (138) 

2 2 
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The derivative of Vi along the solution of (137) is given by 


Vi = - {K - mci)\\e^\\^ - Cik^We^W^ 

^ikyCx ‘ T ^ ' \^C\Cx T 

+ ^x^x ■ {e„ + ciCx}- ^x^x- (139) 

'lx 

For the hrst case of the adaptive law given by (25), the last two terms of (139) are 
cancelled out. Also for the second case [60] that 9x = 7 a;(/ — fl^)Wj(et, + CiCj,), we 
obtain 


Fl (^If ^^Cl)||e|;|| Cl11 Ca, 11 

C\kyCx ‘ C^J T X * \^C\Cx T C|;} 

+ CiCx). (140) 

9x 

In the above equation, the last term on the right hand side is always negative since 
+ CiCa) > 0 and < 0. Therefore for both cases of (25), we obtain 

Fi ^ (^u CnCi)||eaj|| Ci/Ca||Ca|| Ci/c^jCa ‘ C^ T • {CiCa, T Ca,)" • (141) 

The last term of the above equation corresponds to the effects of the attitude tracking 
error on the translational dynamics. We hnd a bound of X, dehned at (136), to 
show stability of the coupled translational dynamics and rotational dynamics in the 
subsequent Lyapunov analysis. Since / = ||A||(cgi^^i^es), we have 

||X|| <||A|| \\{ejRjRes)Res-Rce3\\ 

^(^a;||cx|| + ^d||c«|| + + Bi) X || (e^i?Ji?e3)i?e3 — i^cCall- 
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The last term \\{e^]^Re^)Re 2 , — Rc^^W represents the sine of the angle between 63 = 
Rez and 603 = Rc^Zi since ( 63 ^ ■ 63)63 — 63 ^ = 63 x (63 x 63 ^). The magnitude of the 
attitude error vector, ||eR|| represents the sine of the eigen-axis rotation angle between 
Rc and R (see [41]). Therefore, ||(e|’i?^i?e 3 )i?e 3 — Rc^^W < ||e_R|| in Di. It follows 
that 


||(e[i?Ji?e3)i?e3 -i?de3|| < He^H = ^^(2 - T) 

< |v/^i(2-^i) 4 a} < 1. (142) 

Therefore, X is bounded by 

ll^ll ^ (^x||ea;|| -|- A;t,||et,|| -|- Bw^Bg + i?i)||e/j|| 

^ (^xllexll + -|- B\y^Bq + Bi)a. (143) 

Substituting (143) into (141), 

Vi < -{Kil - a) - mci)||e^|p - CiA;2,(l - a)||e2,|p 

+ Ci/i;^(l -|- Q;)||ea;|| ||et,|| 

+ ll^rjll {{^Wx^e + -Bi)(ciII 62,11 -|- ||e2,||) + /CxHcxH ||e,;||} . (144) 

In the above expression for Vi, there is a third-order error term, namely /^x||e_R|| ||ea;|| ||e„| 
Using (142), it is possible to choose its upper bound as /i:a;Q:||ea;||||e„|| similar to other 
terms, but the corresponding stability analysis becomes complicated, and the initial 
attitude error should be reduced further. Instead, we restrict our analysis to the 
domain Di dehned in (242), and its upper bound is chosen as /^xea;„, 3 ^,,||eK||||e„||. 
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c) Lyapunov Candidate for the Complete System 


Let V = Vi + V 2 be the Lyapunov candidate of the complete system. Define Zi = 
[||ex||, ||et,||]^, 2:2 = [||eij||, ||eo||]'^ G and 

Using (243), the bound of the Lyapunov candidate V can be written as 


MiiZi + z'^IVI21Z2 + Vy 4 ^ V < z'^M12Z1 + Z2 M22Z2 + Va, ( 145 ) 


where the matrices Mu, M 12 , M 21 , M 22 are given by 


Mu = ^ 


M 21 — - 


kx —mci 
-mci m 

kn —C2 \m 

-C2^m a m 


Mi2 — - 


M 22 — — 


kx mci 
mci m 

C2XM Xm 


Using (236) and (144), the time-derivative of V is given by 


V < -z^WiZi + zlWi 2 Z 2 - z'^W 2 Z 2 < -z'^Wz (146) 


where 2 : = [ 2 : 1 , 2 : 2 ]^ G M^, and the matrices lUi,lUi 2 ,lU 2 G are defined at (29)- 
(31). The matrix W G is given by 


A^(lUi) -IIIIU12II2 
-IIIIU12II2 A,„(1U2) 


The conditions given at (237), (27), (28) guarantee that all of matrices Mu, M^, M 21 , M 22 , W 
are positive definite. According to the LaSalle-Yoshizawa theorem [65, Theorem A.8], 
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this implies that the zero equilibrium of tracking errors and the estimation errors is 
stable in the sense of Lyapunov, and tracking errors asymptotically converge to zero. 
Furthermore, estimation errors are uniformly bounded. 

A. 4 Proof for Proposition 4 

According to the proof of Proposition 2, the attitude tracking errors asymptotically 
decrease to zero, and therefore, they enter the region given by (26) in a finite time t*, 
after which the results of Proposition 3 can be applied to yield attractiveness. The 
remaining part of the proof is showing that the tracking error zi = [||ea;||, ||e^||]^ is 
bounded in t G [0,P]. This is similar to the proof given at [28]. 

A. 5 Proof for Proposition 5 

From (38) and (40), the Lagrangian is given by 

^ n 1 ^ 

L = -Moo||i|P + i ■ X] ^oiQi + 2 X] 

i=l = l 

n n ^ 

magkes ■ qi + Mooge^ ■ x + JQ, (147) 

2=1 a=i 

The derivatives of the Lagrangian are given by 

T)xL = Mooges, 

n 

= Moox + ^ MoiQi, 
i=l 

where represents the derivative of L with respect to x. From the variation of 
the angular velocity given after (77), we have 

BnL -6^ = m-{g + nxr]) = jn-T]-7]-{nx m). (148) 
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Similarly from (78), the derivative of the Lagrangian with respect to g* is given by 


n 


DqX ■ 5qi = y^^magljes ■ (^i x qi) 

a=i 

The variation of g* is given by 


n 

'Y^niaglihqi ■ ii- 

a=i 


Sqi = iiXqi + ^iX qi- 


Using this, the derivative of the Lagrangian with respect to qi is given by 

n 

Dg.L ■ 5qi = {Miox + ^ Mi^q^) ■ 5qi 

i=i 

n 

= {MioX + ^ Mijqj) ■ iiiX q + ^iX g*) 
i=i 

n n 

= qi{MioX + ^ Mijqj) ■ ii + qi{MioX + ^ Mij^j) ■ ^i. 
j=i i=i 

Let 0 be the action integral, i.e., 0 = Ldt. From the above expressions for the 
derivatives of the Lagrangian, the variation of the action integral can be written as 

pt f 

6(S= {Moox + ^ Moidi} ■ dx + Mooges ■ Sx 
Jto 

n n 

i{MioX + ^ Mijqj)} ■ ^i 
i=l j=l 

n n n 

ii^MiQX + ^ ^ Mjjdj) ^ ^^ ^agh^sQi} ■ C* 

i=l j=l a=i 

+ Jfl ■ g — g ■ X Jfl) dt. 
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Integrating by parts and using the fact that variations at the end points vanish, this 
reduces to 


pt f ^ 

6(5 = {Mooges - Mqqx - ^ Moig*} ■ 5x 

Jto 

n n n 

+ y^^{-qi{Miox + ^ Mijqj) - ^ maglihqi] ■ ^ 
2=1 j=l a=i 

— g ■ {j(l + n X Jhl) dt. 


According to the Lagrange-d’Alembert principle, the variation of the action integral 
is equal to the negative of the virtual work done by the external force and moment, 
namely 


r-tf 


{-fRes + A^) ■ 6x + {M + Ar) ■ g dt, 


(149) 


>to 


and we obtain (43) and (45). As is perpendicular to g*, we also have 

n n 

-qj{Miox + ^ Mijqj) + ^ magkqje^ = 0. (150) 

j=l a=i 

Equation (150) is rewritten to obtain an explicit expression for qi. As qi ■ qi = 0, we 
have (ji ■ (ji + qi ■ (ji = 0. Using this, we have 


-QiQi = -{<li ■ Qi)Qi + {r ■ (!i)Qi = + Qi- 


Substituting this equation into (150), we obtain (44). This can be slightly rewritten 
in terms of the angular velocities. Since = ca* x g* for the angular velocity cuj 
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satisfying qi ■ Ui = 0 , we have 


Qi = Ui X Qi + Ui X {Ui X Qi) 

= UiX qi - \\ui\\‘^qi = -qitOi - HcUilpg*. 

Using this and the fact that ■ g* = 0, we obtain (47). 

A.6 Proof for Proposition 6 

The variations of x, u and q are given by (51) and (52). From the kinematics equation 
(ji = Ui X qi, 6qi is given by 

6qi = ii X 63 = 6Ui X 63 + 0 X {^i X 63) = SUi X 63. 

Since both sides of the above equation is perpendicular to 63, this is equivalent to 
63 X ((i X 63) = 63 X {Sui X 63), which yields 


^ - (es ■ i)e3 = 5ui - {63 ■ 5ui)63. 


Since ii- 63 = 0 , we have ■ 63 = 0 . As 63 ■ 5 ui = 0 from the constraint, we obtain the 
linearized equation for the kinematics equation: 

6 (151) 

Substituting these into (47), and ignoring the higher order terms, we obtain (53). 
See [ 66 ] for details. 
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A.7 Proof for Proposition 7 

We first show stability of the rotational dynamics, and later it is combined with 
the stability analysis of the translational dynamics of quad rotor and the rotational 
dynamics of links. 

a) Attitude Error Dynamics 

Here, attitude error dynamics for c/j, cq are derived and we hnd conditions on control 
parameters to guarantee the boundedness of attitude tracking errors. The time- 
derivative of Jcq can be written as 


Je^ — {JeQ, + d}^eQ — kRCR — k^en — kjcj + Ar, (152) 

where d = (2J — tr[J]I)R"’"Rdkld £ 1^^ [64]. The important property is that the first 
term of the right hand side is normal to e^, and it simplihes the subsequent Lyapunov 
analysis. 

b) Stability for Attitude Dynamics 

Define a configuration error function on SO(3) as follows 

= (153) 

We introduce the following Lyapunov function 

V 2 =7760 ■ JeQ + kji^{R, Rd) + C 2 eR ■ cq -f -ki\\ei -(154) 

Z Z Kj 

Consider a domain D 2 given by 

D 2 = {{R, n) G S0(3) X I < ^2 < 2}. (155) 


111 



In this domain we can show that V 2 is bounded as follows [64] 


Z2M21Z2 + ^||e/ - ^ 11 ^ < V2 < Z2M22Z2 + ^||e/ - 

Z Kj Z Kj 


where Z 2 = [||ei{||, ||en||]^ G and the matrices M 21 , M 22 are given by 


( 156 ) 


1 

M21 = - 

kR 

—C2^M 

, M22 — - 

2kft, 

2-^2 

C2^M 

2 

—C2^M 


2 

C2^M 

Am 


(157) 


The time derivative of V 2 along the solution of the controlled system is given by 
V2 = — /co||en||^ — cq ■ {kiej — Afi) + c2eR ■ JeQ,-\- C2eR ■ Je^ + {kiej — Aij)e/. 


We have e/ = 026 ^ + from (67). Substituting this and (230), the above equation 
becomes 


V2 — — /^o||eo||^ + C2eR ■ Jcq — C2/i:/j||eij||^ + 026/? ■ ((Je^ + d)^eQ — kuen). 

We have ||ej?|| < 1, ||eR|| < ||eQ|| [64], and choose a constant B 2 such that ||(i|| < B 2 . 
Then we have 


V 2 < -Z 2 W 2 Z 2 , 


(158) 


where the matrix W 2 G is given by 


11^2 


C2kR —^{kQ + B2) 
“^(^0 + 7^2) kfi — 2 c 2 \m 
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The matrix W 2 is a positive definite matrix if 


C 2 < min{ 


VknXm 4:kQ 

Am ’ SkjiXM + {kn + -82)^ 


}• 


( 159 ) 


This implies that 


V2<-A^(lT2)|k2f, 


(160) 


which shows stability of attitude dynamics. 

c) Translational Error Dynamics 

We derive the tracking error dynamics and a Lyapunov function for the translational 
dynamics of a quadrotor UAV and the dynamics of links. Later it is combined with 
the stability analyses of the rotational dynamics. This proof is based on the Lyapunov 
method presented in Theorem 3.6 and 3.7 [63]. From (51), (43), (53), and (105), the 
linearized equation of motion for the controlled full dynamic model is given by 

Mx + Gx = B{-fRe 3 - Mooge^) + 0 (x, x) + BA,^,, (161) 

and 0 (x, x) is higher order term. The subsequent analyses are developed in the domain 

D, 


Di = {(x,x, i?, en) e 


X 


X SO(3) X I T < < !}• (162) 


In the domain Di, we can show that 




(163) 
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Consider the quantity e^RjRe^, which represents the cosine of the angle between 
63 = Res and 63 ^ = RcCs- Since 1 — i?c) represents the cosine of the eigen-axis 
rotation angle between Rc and R, we have e^R^Res > 1 — \h(-R,-Rc) > 0 in Di. 
Therefore, the quantity is well-dehned. We add and subtract to 

the right hand side of (239) to obtain 


Mi + Gx =B( 


-/ 

e^R^Res 


RcCs - X - Mooges + A^) + 0 (x, x), 


(164) 


where X G is dehned by 


^ = e^RTRes ((^3RcR(^3)Re3 - RcCs)- 

The hrst term on the right hand side of (164) can be written as 

/ ^ (||A||R,e3)-i?e3 A 

ejR^Re:, ' II-411 

Substituting this and (57) into (164) 


(165) 


(166) 


Mx -|- Gx = B(—Xa-x — X^x — Kz sat(ex) — X + A^,) -|- 0 (x, x), (167) 

a 


This can be rearranged as 


if = - (M-^G + M-^BR:,,)x - (M-^BXi)* 

- M'^BX - M-^BX^ sat(ex) + M-^ 0 (x, x) + M'^BAa,. 

cr 


( 168 ) 


Using the dehnitions for A, B, and Zi presented before, the above expression can be 
rearranged as 


ii =A 2 :i -f- B(—BX -I- 0 (x, x) — BX^ sat(ex) + BAj,). (169) 

cr 
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d) Lyapunov Candidate for Translation Dynamics 

From the linearized control system developed at section 3, we use matrix P to intro¬ 
duce the following Lyapunov candidate for translational dynamics 

re^ 

Vi = ZiPzi + 2 / (BiF^ sat(/i) — BAa;) ■ d/i. (170) 

•Jpeq ^ 

The last integral term of the above equation is positive definite about the equilibrium 
point Cx = Peq where 

Pe, = [^,0,0,---], (171) 


if 


5 < k,a, (172) 

considering the fact that sat^- y = y if y < a. The time derivative of the Lyapunov 
function using the Leibniz integral rule is given by 

Vi = z^Pzi -\- z^Pzi + 2ex ■ (BKz sat(ex) — BA^,). (173) 

a 

Since = ((PB)^; 2 i)^ = zJ^PM from (58), the above expression can be written as 
Vi = z^Pzi + z^Pzi + 2zJPUCBKz sat(ex) — BA^,). (174) 

(7 

Substituting (249) into (174), it reduces to 

Vi = z'[{A^ P + PA)zi + 2zf PB{-BX + (175) 
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Let C 3 = 2 ||PBB ||2 G M and using A'^P + PA = —Q, we have 

Vi < -z'[Qzi + C 3 || 2 :i||||X|| + 2z'[PBg{^,±). (176) 

The second term on the right hand side of the above equation corresponds to the 
effects of the attitude tracking error on the translational dynamics. We hnd a bound 
of X, dehned at (245), to show stability of the coupled translational dynamics and 
rotational dynamics in the subsequent Lyapunov analysis. Since 

f=\\A\\{elR^Re,), (177) 


we have 


||X|| < \\A\\\\{ejR^Re,)Res-Rces\\. (178) 

The last term \\{ejR'^Re 3 )Re 3 — RcCsW represents the sine of the angle between 63 = 
Res and 63 ^ = Pc^s, since ( 63 ^ ■ ^ 3)63 — bs^ = bs x (63 x 63 J. The magnitude of the 
attitude error vector, ||ei?|| represents the sine of the eigen-axis rotation angle between 
Rc and R. Therefore, 11 ( 63 ^^^ 63)^63 — Rc^sW < ||e/j|| in Di. It follows that 

\\{elRlRes)Res - P.63II < ||6^|| = ^^(2 - T) 

,_ (179) 

< '4)i{2 -'ilJi) = a} < 1, 


therefore 


I|77||<||71||||6^|| 
< l|7l||a. 


(180) 
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We also use the following properties 


Amin(Q)|kl|P < z[QZi. (181) 

Note that Aniin(Q) is real and positive since Q is symmetric and positive dehnite. 
Then, we can simplify (254) as given 

Vi < -Amin(Q)lki|P + C3||zi||||A||||eK|| + 2^fPB0(x,x). (182) 


We hnd an upper boundary for 


A = -K^x - K^x - sat(ex) + Mooge^, (183) 

cr 


by defining 


llAfooS'esll < Bi, (184) 

for a given positive constant Bi. We use the following properties where for any matrix 
A e 


ll^lh < y^Pllmax, (185) 

where ||2l||max = niax{amn}- The third term on the right hand side of (259) can be 
bounded as 


P^sat(ex)|| < II-P 2 IIII sat(ex)|| < \\K^\\V2n + 3a, 


(186) 
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where 


K,\\ < y^3(2^^\\K,\U^, 


and similarly 


ll-^xll < \/3{2n + 3) ||i^^x||max; 
||-^x|| ^ \/3(2n + 3) ll-f^xllmax- 


We define K^ax, e M 


Kxaax — IIllmax) ||-^x||max}'\/ 3 ( 2 ?r -|- 3 ), 

^Zm — ■\/3(2n + 3) ll-f^zllinax; 


and then the upper bound of A is given by 


Pll < i^max(||x|| + ||i||) + + B, (187) 

< 2i7max||^i|| + {Bi + aKz^), (188) 

and substitute (261) into (182) 

Vl < - (Amin(Q) - 2c3K^s.^a)\\zi\\^ 

(189) 

+ C3(5i + cTi7^^)||^i||||e/j|| +2^fPB0(x,i). 
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e) Lyapunov Candidate for the Complete System 


Let V = Vi + V 2 be the Lyapunov function for the complete system. The time 
derivative of V is given by 


V = Vi + V 2 . 


(190) 


Substituting (263) and (238) into the above equation 

V < - (Amin(Q) - 2c3iLmaxa)||2:i||^ + 22:fPB0(x,x) 

+ C3(Pi + aP,^)|ki||||e^||-A^(lC2)||;^2ir, 

and using ||eR|| < ||2:2||, h can be written as 


(191) 


V < - (Amin(Q) - 2c3iLmaxa)||2:i|P + 2 ^fPB 0 (x,x) 
+ C 3 (Pl + (TP 2 ^)||^i|| 112:211 - \miW 2 )\\z 2 \\‘^. 


(192) 


Also, the 2zf PB 0 (x, x) term in the above equation is indehnite. The function 0 (x, x) 
satishes 


Il0(x,i)|| 


Fil 


—y 0 cLs I Zi\\ —y 0 . 


Then, for any 7 > 0 there exists r > 0 such that 


| 0 (x,x)|| < qll^ill, V|| 2 ;i||<r, 


(193) 


(194) 


so, 


27^B0(x,i) < 27||P||2 ||^i 


(195) 
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Substituting the above equation into (266) 


V < - (A„,in(Q) - 2csK^^a)\\z,f + 2-f\\Ph\\z,f 

+ Cs{Bi + aKz^)\\zi\\ || 2 : 2 || — \m{W2)\\z2\\^, 

we obtain 


( 196 ) 


V <-z'^Wz + 2-i\\PU\zif, (197) 

where = [ 2 : 1 , z-^^ G and 

Amin (Q) 2C3-f7jjjaxCl 

C3{B^+uK^^) 

2 

By using || 2 :i|| < ||; 2 ||, we obtain 

V<-(Amin(l^)-27||P||2)lkir. (199) 

Choosing 7 < (Amin(hh))/2||P||2, ensures that V is negative semi-dehnite. This im¬ 
plies that the zero equilibrium of tracking errors is stable in the sense of Lyapunov 
and V is non-increasing. Therefore all of error variables zi, z^ and integral control 
terms e/, Cx are uniformly bounded. Also, from Lasalle-Yoshizawa theorem [63, Thm 
3.4], we have 2 : —)■ 0 as t —)■ cx). 
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A.8 Proof for Proposition 8 


a) Kinetic Energy 

The kinetic energy of the whole system is composed of the kinetic energy of quadro- 
tors, cables and the rigid body, as 


T =-mo||iof + EE 


^ II • Il2 ^ II • ||2 ^ 

-rriijWxijW + ^ > ,mi\\xi\\ 

i=l j=l i=l 


^ ^ * Ji^i ^0 ' 'A)^0* 


i=l 


( 200 ) 


Substituting the derivatives of (73) and (74) into the above expression we have 


^ 71 Tl{ ^ Tti 

T =-mo\\xo\\'^ + ^^-mij\\xo + RoPi- ^ 

1=1 j=l a=j+l 


^ n rii 1 ^ 1 

E flj ■ Ji^i + -tlo ■ '7of^o- (201) 


2 / ^ - t II — o ' / j - II ' 2 

i=l a=l i=l 


We expand the above expression as follow 


n rii 


T =-{mo\\xof + + J^rriillholP 


i=i j=i 


1 = 1 


1 

2 


E(E mijWRopiW'^ + mi\\Ropi\\^) 

i=i j=i 
n Ui 

E(E rriijXo ■ RoPi + rriiXo ■ R^Pi) 

i=l j=l 

n ni 

^ ^ ^ia^iall “1“ II f'iaQi 


i=l j=l a=j+l 

n Ui rii 


a=l 


^ ^ ^ ^iaQia (^'0 ' ^ ^ ^iaQia) 

i=l j=l a=j-\-l a=l 

n rii R'i R’i 

E(E E liaQia + rriiRoPi ■ E ^iaQia} 

i=l j=l a=j+l a=l 

1 n ^ 

— ^ ^ flj ■ Ji^i T 2^^ ' "^0^0’ 

i=l 


( 202 ) 
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and substituting (83), (84), it is rewritten as 


T — -MtIIxqIP + - ^ Mjr||i?oPi|P + y~~^(MtT^o ■ RoPi) 

i=l i=l 

n rii n rii 

+ EE ^^Oij ^ij Qij ) 

2=1 j,k=l 2=1 j=l 

n rii 

- '^{Ropi ■ ■^Oij lij Qij ) 

i=l j=l 

in 1 

+ — ^ ^ ■ Ji^i + 2^0 ' ( 203 ) 

2=1 

b) Potential Energy 

We can derive the potential energy expression by considering the gravitational forces 
on each part of system as given 


n n rii 

V = -moges -xq-Y ^^^^3 ■ - EE rriijges ■ Xij. (204) 

2=1 2=1 j = l 


Using (73) and (74), we obtain 


V 


Ui 


moge^ -Xq-Y ^ides ■ (a^o + RoPi - Y 


2 = 1 


a=l 


n rii 


rii 


Y Y ■ {xo + RoPi - Y ^iaQia), 

i=l j=l a=j+l 


(205) 


and utilizing (84), we can simplify the potential energy as 


n n rii 

V = -Mrges ■ xq-Y ■ RoPi + EE Moijlijqij ■ 63 . (206) 

2=1 2=1 j = l 
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c) Derivatives of Lagrangian 


We develop the equation of motion for the Lagrangian L = T — V. The derivatives 
of the Lagrangian are given by 


n n rii 

D±qL = MtXo + MiTRoPi — EE ^Oij f'ij Qij 1 

2=1 2=1 Jl = l 

DxqL = 

n Hi n 

®«i = EE 

i=l j=l i=l 

n 

^lij^ ^ ^ dLQjj/jj-eg, 

i=l 


(207) 

(208) 

(209) 

( 210 ) 


where D±^ denote the derivative with respect to and other derivatives are dehned 
similarly. We also have 


n n iii n 

DqqL =JoQo + MiTPiR^xo — EE piR^ Qij E MiTp^lo, ( 211 ) 

2=1 2 = 1 Jl = l 2=1 


n rii 

DqqL (/q^q -|- ^ PiRq (^Adij-'XQ ^ ^ •) 

2 = 1 j = l 


2=1 

where Jq is defined as 


( 212 ) 

(213) 


Jo = (214) 

2=1 
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The derivation of the Lagrangian with respect to Rq is given by 


DrqL ■ 5Ro — MiTRoVoCloPi ■ xq 
i=l 

n rii 

- RoVo^oP^ ■ ^^Oij lij Qij 
i=l j=l 

n 

+ ^ MiTge^i ■ RoVoPi, (215) 

i=l 

which can be rewritten as 


DrqL ■ 6Ro — (Irq ■ ?7o, 


(216) 


where 

n __ Hi 

= y^(((^oP^^o (M^tAq) - ^ Moijlijqij) + MiTgpiRle^)). (217) 

i=l j=l 


d) Lagrange-d’Alembert Principle 

Consider 0 = L be the action integral. Using the equations derived in previous 
section, the inhnitesimal variation of the action integral can be written as 


Rf 

5(3 = D±^L ■ 5xq + ■ 5xo 

Jto 


+ DnoL{po + flo X ?7o) + cIrqL ■ go 

n rii 

T ^ ^ ^ ^ ^qij^iiij X Qij + ^ij X Qij) 

i=l j=l 
n rii 

+ ^qij^ ■ i^ij ^ ^ij) 

i=l j=l 
n 

+ DqR ■ (rji + hlj X gi). 

i=l 


(218) 
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The total thrust at the i-th quadrotor with respect to the inertial frame is denoted by 
Ui = —fiRiCz G and the total moment at the i-th quadrotor is dehned as Mi G 
The corresponding virtual work is given by 

/ fj,n TLi 

Ui ■ {5X0 + RofjoPi - lijiij X qij} + Mi-rji dt. (219) 

J i=l j=l 

According to Lagrange-d Alembert principle, we have 50 = —5W for any variation 
of trajectories with hxes end points. By using integration by parts and rearranging, 
we obtain the following Euler-Lagrange equations 


d 

dt 


DxiL DxqL ^ ^ Uj^ 


i=l 


d 

dt 


Dqo + flo X -Doo — dRg — piR^Uj, 

i=l 

. d 

~ ~ ~hjQijUi, 

+ Hi X = Mi. 


( 220 ) 

( 221 ) 

( 222 ) 

(223) 


Substituting the derivatives of Lagrangians into the above expression and rearranging, 
the equations of motion are given by (79), (80), (81), (82). 

A.9 Proof for Proposition 9 

The variations of x and q are given by (93) and (94). From the kinematics equation 
dij = Uij X qij and 


dqij = iij X 63 = 5ujij X 63 0 X (^^ x 63) = 5ujij x 63. 
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Since both sides of the above equation is perpendicular to 63 , this is equivalent to 
es X {iij X 63) = 63 X {Suij X 63), which yields 




Since ^ij • 63 = 0 , we have ^ij • 63 = 0 . As 63 ■ Suij = 0 from the constraint, we obtain 
the linearized equation for the kinematics equation of the link 


5(jJij. 


(224) 


The inhnitesimal variation of Rq G SO(3) in terms of the exponential map 


/?oexp(er)o) = -Roho, (225) 

e=0 

for po £ Substituting these into (79), (80), and (81), and ignoring the higher 
order terms, we obtain the following sets of linearized equations of motion 


5Ro = ^ 

de 


MtSxq — ^ ^ MiTpiS^o + EE Mop/pe3C'(C'%) = ^ 5ui (226) 

i=l j=l 


2=1 


2=1 


MoijlijPiesCiC'^iij) + ^ —gpih'no = PMi 

i=l j=l 


2=1 


2 = 1 


2=1 


(227) 

rii 

—MQijC'^e^Sxo + MoijC'^e^pidilo + 'jij) 

k=l 

= —C'^e^dui + {—MiT - — + MQij)ge^l2{C"’"p^ij) (228) 

pi = 5Vli, po = SQo, JiS^i = SMi, (229) 


which can be written in a matrix form as presented in (95). See [ 66 ] for detailed 
derivations for a similar dynamic system. We used C'^e^C = —R to simplify these 
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derivations. 


A. 10 Proof for Proposition 10 

We first show stability of the rotational dynamics of each quadrotor, and later it is 
combined with the stability analysis for the remaining parts. 

a) Attitude Error Dynamics 

Here, attitude error dynamics for cr., eQ^ are derived and we hnd conditions on 
control parameters to guarantee the boundedness of attitude tracking errors. The 
time-derivative of J^en^ can be written as 

= {'JiGUi + — kjieji^ — kQeQ^, (230) 

where di = (27* — tT[[Ji\I])Rj G [45]. The important property is that the 
hrst term of the right hand side is normal to en^, and it simplihes the subsequent 
Lyapunov analysis. 

b) Stability for Attitude Dynamics 

Dehne a conhguration error function on SO(3) as follows 

>!>. = itr[l|/ - RfR,]. (231) 

We introduce the following Lyapunov function 

n 

n = (232) 

i=l 
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where 


V2i — -e^i ■ JiGfii + kR^i{Ri, RdJ + C2.ei?; • en,- 


(233) 


Consider a domain D 2 given by 


D 2 = {{Ri, Qi) e SO(3) X I < ^2, < 2}. 


(234) 


In this domain we can show that V 2 is bounded as follows [45] 


zlMi^^Z 2 ^ < V 2 , < zlMi^^Z 2 ,, 


and Z 2 i = [IIcrJI, G Matrices Mjjj, given by 


A4. =2 


A4. =2 


kn —C2^^Mi 
-C2,^Mi A rrii 


2 fcr 


2 _V,2, C2 ,Am, 
C 2 ; Am, Am, 


(235) 


The time derivative of V 2 along the solution of the controlled system is given by 


n 

V2 = + C2^eR^ ■ Rcq. + C2^eR^ ■ 

i=l 

Substituting (230), the above equation becomes 

n 

V 2 = —/^o||enJ|^ + 02^6^; ■ JjCQ. — C2iA;ij||ei?J|^ 

i=l 

+ C2,eK, ■ {{Reni + di)^en, - knen.). 
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We have HcrJI < 1, i|eijJ| < [64], and choose a constant B 2 ^ snch that ||(ij|| < 

Bi^. Then we have 

n 

V 2 <-'^zlW2^Z2^■, (236) 

i=l 

where the matrix hh 2 ^ G is given by 


W 2 . = 


C2,k 


R 


-^{kn + B2J 


-^{kn + B2^) k^ — 2c2^\Mi 


The matrix 14^2^ is a positive definite matrix if 


C 2 . < min{ 


■\J kjiX^m 4 /uq 

^Mi ’ 8kiiXMi + {kn + Bi^Y 


}• 


(237) 


This implies that 

n 

1>2<-5;A„(»'-2.)||22.|P, (238) 

i=l 

which shows stability of the attitnde dynamics of qnadrotors. 


c) Error Dynamics of the Payload and Links 

We derive the tracking error dynamics and a Lyapnnov fnnction for the translational 
dynamics of a payload and the dynamics of links. Later it is combined with the 
stability analyses of the rotational dynamics. From (79), (95), (100), and (105), the 
eqnation of motion for the controlled dynamic model is given by 


Mx + Gx = B(n — u*) + 0 (x, x). 


(239) 
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where 



Ui 


-{M3T+^)9e3 


U2 


-{M2T+^)9e3 

u = 


, U* = 



R-n 


— {MnT + ^)9^3 


( 240 ) 


and 0 (x, x) corresponds to the higher order terms. As Ui = —fiRiC^ for the full 
dynamic model, Su = u — u* is given by 


6u = 


-fiRie3 + {M,T+^)9e3 
-f2R2e3 + {M2T+^)9e3 


-fnRne3 + [MnT + ^)9e3 


The subsequent analyses are developed in the domain Di 


(241) 


Di ^ {(x,x,R,,enJ e 




X 




X SO(3) 


X 


T, < ^1, < 1}. 


(242) 


In the domain Di, we can show that 

2 < ^i{Ri, RcJ < \\^R^\\^ ■ ( 243 ) 

Consider the quantity which represents the cosine of the angle between 

63 . = and 63 ^, = i^cTs- Since 1 — 'hj(i?j,i?cj represents the cosine of the eigen- 
axis rotation angle between Rc^ and i?*, we have e^R^.Re 3 > 1 —^^(i^j, > 0 in Di. 

Therefore, the quantity „ — is well-dehned. We add and subtract ttdtt, —R c es 
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to the right hand side of (241) to obtain 


+ (Mir + ^)^e3 
er^Rc.es-X, + {M,r + ^)9e^ 


(244) 


eTRT"R^ezR<^X^ + i^riT + ™“)fl'e3 


where Xi G is dehned by 


Xi = ((elRlflie 3 )Riei - RcS,). 


(245) 


Using 


__ /? _ _ \ 11 11 ’J / 

elRlRiC^i ^ 


(||^j||-Rcie3) ■ RiC^ Ai 




— Ai, 


(246) 


the eqnation (244) becomes 


Ai - Xi + (Mir + ^)ge^ 
A 2 — X 2 + {M 2 T + ^)fi'e3 


(247) 


7l„-X„ + (M„r + ^)(/e3 


Snbstitnting (100) into the above eqnation, (239) becomes 


Mx + Gx = B(—XxX — XxX — X) + 0 (x, x), 


(248) 


where X = [X^, Xj, ■ ■ ■ , X'^Y ^ It is rewritten in the following matrix form 


ii = A;^! + B(BX + 0 (x, x)), 


(249) 
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where Zi = [x, x]^ G and 



0 / 


0 

A = 

-M-^(G + BAx) -M-^BAx 

,B = 

M-i 


We can also choose i^x and Ky^ such that A G is Hurwitz. Then for any 

positive dehnite matrix Q G ]^2_Dxx2Dx^ there exist a positive dehnite and symmetric 
matrix P G k2Dxx2_Dx ^p _|_ pp^ = _q according to [63, Thm 3.6]. 

d) Lyapunov Candidate for Simplified Dynamics 

From the linearized control system developed at section 3, we use matrix P to intro¬ 
duce the following Lyapunov candidate for translational dynamics 


Vi = zlPzi. (251) 

The time derivative of the Lyapunov function using the Leibniz integral rule is given 
by 

Vi = ZiPzi + ZiPzi- (252) 

Substituting (249) into above expression 

Vi = zl{A^ P + PA)zi + 2zJ PB{BX + (253) 

Let C 3 = 2 ||PBB ||2 G M and using A^P -|- PA = —Q, we have 

Vi < -zlQzi + C'iWziWWXW 22 :fPB 0 (x,x). (254) 
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The second term on the right hand side of the above equation corresponds to the 
effects of the attitude tracking error on the translational dynamics. We hnd a bound 
of Xj, defined at (245), to show stability of the coupled translational dynamics and 
rotational dynamics in the subsequent Lyapunov analysis. Since 


f, = \\A,\\(elRlR,e3), (255) 

we have 

< 11^*11 II(es II- (256) 

The last term ||(cgi?^i?je 3 )i?je 3 — i^cTsll represents the sine of the angle between 
63 ^ = RiCs and 63 ^^ = i^cTs, since ( 63 ^, = & 3 , x ( 63 , x b^^J. The magnitude 

of the attitude error vector, ||ei?J| represents the sine of the eigen-axis rotation angle 
between and Ri. Therefore, || (e^i?^i?je 3 )i?je 3 — i^cTsll — II^rJI in T*i. It follows 
that 


\\{elRlRie3)Rie3 - RcM\ < \M\ = ^^^( 2 -^^) 

<{V^i^(2-^iJ 4 «,}<!, (257) 


therefore 


ll^dl<Pdll|eKj 

< WMWi- 


We hnd an upper boundary for 


Ai = -XxX - XxX -1- u*, 


(258) 


(259) 
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by defining 


IKII < Bi.. (260) 

for a given positive constant Bi. defining K^ax ^ 

-^max niax-[ 1111,11 11 ]■, 

and then the upper bound of A is given by 

ll^ill < it'maxdixll + ||x||) + Bi 

< 2 i^^max||^l|| + -Bl- (261) 

Using the above steps we can show that 

n 

IIA'II <5^((2A'„„||*,||+Bi)||e„,||) 

i=l 

< (2i^^max||2:i|| +(262) 

where a = X]r=i Then, we can simplify (254) as 

n 

Vl < - (Amin(Q) - 2C3it'maxa)|kl|P + ^ Cs^i || 2(11 | ||CrJI + 22 ;f PBfl(x, x). (263) 

i=l 

e) Lyapunov Candidate for the Complete System 

Let V = Vl + V 2 be the Lyapunov function for the complete system. The time 
derivative of V is given by 


V = Vl + V2. 


(264) 
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Substituting (263) and (238) into the above equation 


V < - (Amin(Q) - 2c3irmaxa)lki|p + 22;fPB0(x,x) 

n n 

+ ^c,B,|| 2 ,||||eH,|| (265) 

i=l i=l 


and using ||ei?J| < || 2 : 2 * 11 , it can be written as 


V < - (Amin(Q) - 2c3p'maxa)||2:i||^ + 22;fPB0(x,x) 

n n 

+ ^C3Pi||2:i||||2:2j| - ^ Am(hh 2 j||^ 2 i||^- (266) 

i=l i=l 


The 2 ^fPB 0 (x, x) term in the above equation is indehnite. The function 0 (x, x) 
satishes 


Il0(x,i)|| 




—y 0 as 11 ^ 111 —t 0 . 


Then, for any 7 > 0 there exists r > 0 such that 


|| 0 (x,i)|| < qll^ill V||^i||<r. 


Therefore 


2 zfPB 0 (x,i)< 27 ||P|| 2 |kif 


(267) 


Substituting the above inequality into (266) 


V < - (A„,in(Q) - 2c^K^^a)\\z,f + 27 ||Pi| 2 ||; 2 i|p 

n n 

+ ^csPiII2:1 IIII2:2^1 - ^ Am(hh 2 i) 112:2* 11 ^, ( 268 ) 

i=l i=l 


135 



and rearranging 


vs-Z' 


'^min (Q) 2 C 3 /i"niaxCl II ||2 
- ^l| 


i=l 


n 


- C3-Bl||2:i||||2:2i|| + ^m{W2i)\\z2i\\ ) 


27l|Pil2|ki|P, 


( 269 ) 


we obtain 


V <+ 2^\\PUzi\\^ 

i=\ 


where Zj = [|| 2 :i||, || 2 : 2 j|]^ G and 


(270) 


W, 


^min(^) 2c3./^'niaxQ 
n 

_C3^ 

2 


2 


A,„(H' 2 .) 


(271) 


By using || 2 ;i|| < ||zj||, we obtain 


V<-5^(A„,in(lB,) 

i=\ 


2l\\P\\'. 


n 


Choosing 7 < n(Amin ( 1 B,))/ 2 ||P|| 2 , and 


(272) 


A„^(1B2J > 


n\ 


I C 3 S 1 


'^min (Q) 2C3-f7niaxCl 


(273) 


ensures that V is negative dehnite. Then, the zero equilibrium is exponentially stable. 
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